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ABSTRACT 


The requirements and mathematical specifications for the 
Gamma Ray Observatory (GRO) Dynamics Simulator are presented. 
The complete simulator system, which consists of the Profile 
Subsystem, Simulation Control and Input/Output Subsystem, 
Truth Model Subsystem, Onboard Computer Model Subsystem, and 
Postprocessor, is described. The simulator will be used to 
evaluate and test the attitude determination and control 
models to be used on board GRO under conditions that simulate 
the expected in-flight environment. 
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SECTION 1 - INTRODUCTION 


This document presents the requirements, functional specifi- 
cations, and mathematical specifications for the Gamma Ray 
Observatory (GRO) Dynamics Simulator. The GRO Dynamics 
Simulator will provide an analytical tool for testing and 
evaluating the attitude determination and control system to 
be used on board the GRO spacecraft. The system will be 
tested and evaluated under conditions that simulate the 
expected in-flight environment as closely as possible. 

1.1 MISSION OVERVIEW 

GRO will constitute a major advance in gamma ray astronomy 
by offering the first opportunity for comprehensive observa- 
tions that cover a wide energy range from 0.1 to 30,000 mega 
electronvolts (MeV) . Relatively long exposures using 
extremely large and heavy instruments in orbit above the 
absorbing atmosphere are required to make these observations 

The GRO spacecraft is tentatively scheduled to be launched 
by the Space Transportation System (STS) from the Eastern 
Test Range in June 1990. The operational orbit will be cir- 
cular, at an altitude between 350 and 450 kilometers (km) 
and an inclination of 28.5 degrees (deg). GRO will carry a 
hydrazine propulsion system to achieve a Hohmann orbit 
transfer from the nominal shuttle orbit at an altitude of 
296 km to the mission orbit. Science requirements necessi- 
tate an undisturbed inertial orientation for at least 
2 weeks for each target. 

GRO will have a 2-year science mission lifetime, with two 
possible 6-month extensions. After completing the science 
mission, GRO will be returned to Earth during a 3-month 
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phase. Either it will be retrieved with the STS or its re- 
entry will be controlled. 

1.1.1 MISSION OBJECTIVES 

The study of cosmic gamma rays is the primary mission objec- 
tive of GRO. The observatory will carry the following four 
scientific instruments for this study: 

1. The Oriented Scintillation Spectrometer Experiment 
(OSSE) will observe line and continuum gamma ray 
sources in the 0.1- to 10-MeV range and solar gamma 
rays and neutrons above 10 MeV. 

2. The Imaging Compton Telescope (COMPTEL) will per- 
form a sensitive survey of gamma rays in the 1- to 
30-MeV range with good angular resolution and low 
background . 

3. The Energetic Gamma Ray Experiment Telescope 
(EGRET) will search for discrete gamma ray sources 
in the 20- to 30,000-MeV range. EGRET will measure 
gamma ray intensity, energy spectrum, position, and 
time variations. 

4. The Burst and Transient Source Experiment (BATSE) 
will monitor the entire unocculted sky for tran- 
sient gamma ray events and bursts. BATSE is op- 
timized for gamma rays in the 0.06- to 6-MeV range 
and will provide burst signals to the other instru- 
ments . 

1.1.2 SPACECRAFT CONFIGURATION 

Views of the GRO spacecraft from the +Z axis and the -Z axis 
are shown in Figures 1-1 and 1-2, respectively. The physical 
parameters of interest are given in the following tabula- 
tion. Numbers are approximate and are current as of 
December 1988. 
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COMPTEL 
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Figure 1-1. View of GRO Spacecraft From +Z Axis 









Figure 1-2. View of GRO Spacecraft From -Z Axis 



Parameter 


Value 


Total mass (end of life 
(EOL) , empty) 

Length 

Diameter 


29,820 pounds mass (lbm) 
(13,555 kilograms (kg)) 

9.2 meters (m) 

4.5m 


Total power 


Hydrazine propellant mass 


Moments of inertia (be- 
ginning of life (BOL).) 
(Maximum limits) : 
Maximum weight 


I 

I 

I 

I 

I 

I 


xx 

yy 

zz 
xy ' 
xz ' 
yz ' 


I 

I 

I 


yx 

zx 

zy 


1,900 watts (W) 

4,248 lbm (1,931 kg) 


15,694 kg 
54,696 kg* m^ 
82,440 kg*m 2 
100,991 kg*m 2 
32.5 kg*m 2 
-3,974 kg*m 2 
-6.8 kg*m 2 


The major spacecraft subsystems and their capabilities are 
as follows: 


1. Scientific Payload — OSSE, COMPTEL, EGRET, BATSE. 

2. Thermal Control Subsystem (TCS) — Provides the capa- 
bility to meet thermal requirements of all sub- 
systems . 

3. Propulsion Subsystem (PS) — Provides orbit transfer 
and orbit trim maneuver capabilities. 

4. Electrical Power Distribution Subsystem (EPDS) — 

Uses the Multimission Modular Spacecraft (MMS) 
Modular Power Subsystems (MPSs) and the steerable 
solar arrays to provide electrical power to the 
subsystems . 

5. Communications and Data Handling Subsystem (CADHS) — 
Provides capability for telecommunications and com- 
mands by using a high-gain antenna (HGA) , two 
low-gain antennas (LGAs), and a CADH module similar 
to the MMS module. CADHS also provides an onboard 
computer (OBC) . A GRO-unique feature is the time 
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transfer unit (TTU) , which permits the synchroniza- 
tion of spacecraft clock time to universal coordi- 
nated time (UTC) . 

6. Attitude Control and Determination Subsystem 

(ACADS) — Provides the capabilities for attitude 
maneuvers and stability for science instrument 
viewing. ACADS is of the MMS heritage. 

A component block diagram is shown in Figure 1-3. 

1.2 ATTITUDE CONTROL AND DETERMINATION SUBSYSTEM 

ACADS has five main functions: 

1. Attitude control — Provides three-axis attitude con- 
trol capabilities for inertial pointing, stabiliza- 
tion maneuvers, safehold, and thruster activation 
during velocity control. 

2. Attitude determination — Determines attitude to sup- 
port the control function and to provide definitive 
attitude annotation in science telemetry. 

3. Ephemeris computation — Computes GRO and Tracking 
and Data Relay Satellite (TDRS) ephemerides by 
using data uplinked from the ground. 

4. HGA pointing — Commands HGA to point to the TDRS 
based on computer ephemerides and on information 
uplinked from the ground on HGA/TDRS contact times. 

5. Solar array control — Provides the capability to 
position the solar arrays in any required orienta- 
tion about its rotational axis. 

ACADS specifications are given in Reference 1. 

1.2.1 ATTITUDE HARDWARE 

All spacecraft attitude hardware is contained in the ACADS. 

The basic ACADS configuration is shown in Figure 1-4. It 
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Figure 1-4. ACADS Configuration 





























shows the various sensor, electronics, and actuator assem- 
blies that constitute ACADS and identifies the interfaces 
between them and other subsystems, such as CADHS, EPDS, and 
PS. The subassemblies that constitute the attitude control 
electronics (ACE) and the drive electronics assembly (DEA) 
are shown within larger boxes that represent the ACE and 
DEA, respectively. Arrows indicate power input. See Appen- 
dix C for acronym definitions. 

ACADS components viewed from the +X axis and -X axis are 
shown in Figures 1-5 and 1-6, respectively. The OBC located 
in the CADHS is an integral part of ACADS. Other major com- 
ponents of ACADS are as follows: 

• Fixed-head star trackers (FHSTs) (2) 

• Inertial reference unit (IRU) (1) 

• Three-axis magnetometers (TAMs) (2) 

• Fine Sun sensors (FSSs) (2) 

• Coarse Sun sensors (CSSs) (4) 

• Magnetic torquers (MTs) (3) 

• Reaction wheels (RWs) (4) 

• Attitude control thrusters (ACTs) (8) 

• Orbit adjust thrusters (OATs) (4) 

The following component descriptions use information from 
References 2 through 9. 

1.2. 1.1 FHST 

The FHST is an attitude sensor that searches for, detects, 
and tracks stars; provides accurate position and intensity 
information on stars in its field of view (FOV) ; and gen- 
erates status flags and parameters that characterize the 
sensor operation. Specifications are as follows: 

• Manufacturer — FHST is made by Ball Aerospace Sys- 
tems Division (BASD); see Reference 3 for FHST details. 
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FHST 1 


AV THRUST! « 
(1 O! 4) 


IRU 


TAM FHST 2 

1 AND 2 


Figure 1-6, ACADS Components (View From -X Axis) 
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• Operation — Light from the object to be tracked 

enters an optical lens. The image of this object is focused 
on the photocathode of an image dissector tube (IDT), which 
magnetically deflects and focuses the electrons onto an 
aperture in a plate. The corresponding signal is amplified 
and processed to provide intensity and position informa- 
tion. The FHST operates in three modes: 

Search mode 

Track mode 

Offset mode 

In the total field of view (TFOV), a search mode consists of 
a horizontal scan pattern with appropriate vertical shifts 
at the ends (raster). Four commandable thresholds set the 
minimum sensitivity for acquiring a star. Position and in- 
tensity output during the search mode do not convey meaning- 
ful information. When a star is acquired, the track mode 
begins . 

A small cross pattern (in the form of a figure 8) is rapidly 
executed at the center of the star image. A STAR PRESENT 
flag is generated to indicate that star position and inten- 
sity data are valid for the tracked star. The track pattern 
remains locked on the star during attitude changes. If the 
star leaves the TFOV, if its intensity falls below the com- 
manded threshold, or if a BREAK TRACK command is received 
from the user, then search mode resumes. During the track 
mode, other stars in the TFOV have no influence on the FHST 
or on its output. 

With the optional offset mode capability, a small offset 
raster scan can be commanded in a reduced field of view 
(RFOV) . If a star is acquired, it will be tracked through- 
out the TFOV. If the star is lost, a reduced scan will con- 
tinue at the original position in the RFOV. 
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Parameters and values--These are as follows: 


Parameter 

TFOV 

RFOV 

Range of star visual magnitudes 

Number of threshold settings 

Maximum tolerable vehicle rate 

Search mode: 

Scan type 

Number of lines in TFOV 
Maximum acquisition time 

Track mode: 

Scan type 
Scan period 
Output rate 

Accuracy 

Nominal data resolution 

• GRO-specific 
the following: 


Value 

8 deg by 8 deg 
1 . 5 deg by 1.5 deg 
+5.7 to -7 
4 

0.3 deg/second (sec) 

Raster 

70 

10 sec (TFOV); 1.5 sec 
(RFOV) 

Unidirectional cross-scan 
100 milliseconds (msec) 
10/sec (each axis) 

10 arc-sec (la) cali- 
brated over 8-deg diam- 
eter circular FOV 

7 arc-sec 


features — FHST options for GRO include 

Stray-light shade 
Bright object sensor 
Shutter housing assembly 
Self-test feature 


GRO has two FHSTs arranged symmetrically with respect to the 
-X spacecraft body axis in the X-Y plane so that their bore- 
sights point to +45 degrees and -45 degrees from the 
-X axis. The approximate locations of the FHSTs are indi- 
cated in Figure 1-6. 

1.2. 1.2 IRU 

The IRU is an attitude rate sensor that consists of a gyro 
package that measures inertial vehicle rates about the 
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sensor axes. Output consists of analog rates, accumulated 
angles, range status, and temperature. Specifications are 
as follows: 


• Manufacturer — IRU is made by Teledyne; see Refer- 

ence 4 for IRU details. 


• Operation — The IRU consists of three spinning 
wheels or rotors. Each rotor is mounted on two gimbals to 
provide 2 deg of freedom and, therefore, rate information 
along two body axes (two-channel output). The six-channel 
IRU configuration provides dual redundancy along each body 
axis. The IRU assembly is fixed in the spacecraft (strap- 
down). The current required to magnetically torque a gimbal 
to maintain null deflection (torque rebalancing) is propor- 
tional to the accumulated rotation angle about the corre- 
sponding body axis (rate integrating mode). Torque current 
is differenced after small intervals of time to generate 
analog rates (rate mode). The IRU can operate either in a 
high-rate or 3 low-rate mode (range status). 

• Parameters and values — These are as follows: 


Parameter 


Value 


Scale factor stability +0.01 percent per month (low rate) 

+ 0.1 percent per month (high 
rate) 

Alignment stability TBD 


Acceleration- insensitive 
drift rate (AIDR) 


Nominal data resolution 


High-rate range 


+0.04 arc-sec/sec for 30 days of 
start-stop operation (low rate) 
±0.0003 arc-sec/sec for 6 hours 
of continuous operation (low rate) 
±0.001 deg/sec for 30 days (high 
rate) 

0.8 arc-sec/count (high rate); 

0.05 arc-sec/count (low rate) 

± 2.0 deg/sec 


Low-rate range 


±400 arc-sec/sec 
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• GRO-specific features — These are as follows: 

Low-power, radiation-resistant electronics 

No heaters or other temperature controls 
(therefore, wide-range temperature performance 
is expected) 

The approximate location of the IRU in the spacecraft is 
indicated in Figure 1-6. 

1.2. 1.3 TAM 

The TAM is an attitude sensor that measures the magnetic 
field at the TAM position. Output along each orthogonal 
sensor axis is the measured magnetic field component along 
that axis. Specifications are as follows: 

• Manufacturer — TAM is made by Schoenstedt; see Ref- 
erence 5 for TAM details. 

• Operation — The TAM uses a saturable-core trans- 
former with a high— permeabi li ty core, an excitation winding, 
and a signal pickup winding. The excitation winding is 
driven with a 10-kilohertz (kHz) sine wave alternatively 
saturating the core in opposite directions. If there is an 
external magnetic field component parallel to the core, each 
time the saturable core makes a transition from one satu- 
rated extreme to the other, a pulse is induced into the 
signal pickup winding. The pulse is proportional to the 
component of the external field in that direction. 

• Parameters and values — These are as follows: 

Parameter Value 

Scale factor 10 volts (direct current)/1600 milli- 

gauss (mG) 

Linearity +0.02 percent full scale 

Noise <6 millivolts (mV) peak to peak 
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• GRO-specific features — The approximate location of 
TAMs in the spacecraft is indicated in Figure 1-6. 

1.2. 1.4 ESS 


The FSS is an attitude sensor that provides two-axis Sun 
direction information with respect to the sensor axes. Out- 
put consists of the angles between the boresight and the 
projections of the Sun vector on the two orthogonal planes 
containing the boresight. Specifications are as follows: 

• Manufacturer — FSS is made by Adcole; see Refer- 
ence 6 for FSS details. 

• Operation — Each two— axis FSS consists of two 

single-axis Sun sensors mounted orthogonally. Each single- 
axis Sun sensor consists of two reticles: a fine reticle 

and a coarse reticle. Each reticle is composed of two thin, 
fused silica plates separated by a fused silica spacer. 
Reticle patterns are located on the insides of the plates. 
Silicon photocell arrays are located beneath the reticles. 

The coarse reticle pattern is gray coded and encodes the 
coarse angle over the total FOV. The fine reticle patterns 
and the resultant photocell currents are used to generate 
fine-angle data. 


Parameters and values — These are as follows: 



Nominal accuracy 
Nominal data resolution 
Stray light FOV 


64 deg by 64 deg for each FSS 
(126 deg by 64 deg total) 

0.019 deg 

0.004 deg 

140 deg by 140 deg for each FSS 


• GRO-specific features — These include two FSS units 
(heads) with one electronics unit. The approximate location 
of FSSs in the spacecraft is indicated in Figure 1-5. 
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1.2. 1.5 CSS 

The CSS is an attitude sensor that provides coarse Sun di- 
rection information with respect to the sensor surface 
normal. Specifications are as follows: 

• Manufacturer — CSS is made by TRW; see Reference 7 
for CSS details. 

• Operation — There are four CSS units, each of which 
* produces an output proportional to the cosine of the angle 

between the Sun direction and the sensor surface normal. 
This output can be combined to provide Sun unit vector in- 
formation in body coordinates. The CSS will be used by the 
OBC and ground systems for attitude determination when the 
Sun is outside the FSS FOV. 


• Parameters and values — These are as follows: 


Parameter 


Value 


FOV 

Nominal resolution 
Scale factor variation 


2ir steradian (sr) for each CSS 
(4ir sr total) 

TBD deg 

12.6 percent 


• GRO-specific features — Four units are located at 
the corners of the solar panels (see Figure 1-5), with their 
surface normals in the plane of the solar panel rotated 
45 deg with respect to the solar panel edges. 


1.2. 1.6 MT 

The MT is an electromagnet used as an attitude actuator, 
which, when energized, generates a torque to effect changes 
in spacecraft angular momenta. Specifications are as fol- 
lows : 


• Manufacturer — MT is made by Ithaco; see Reference 8 
for MT details. 
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• Operation — Each MT consists of two coils connected 
in a series and wound on a ferromagnetic rod. A current 
applied through the MT generates a magnetic dipole moment, 
which interacts with the magnetic field to produce a torque. 

• Parameters and values — These are as follows: 

Parameter Value 

Maximum magnetic dipole moment 2000 amperes (A) •m 2 

Nominal residual magnetic dipole <20 A*m 2 

moment 

Nominal data resolution TBD 

• GRO-specific features — The MTs are located on the 
HGA boom (see Figure 1-2). 

1.2. 1.7 RW 

The RW stores angular momentum and is an attitude actuator 
that can be used to change the angular momentum of the 
spacecraft. Specifications are as follows: 

• Manufacturer — RW is made by Sperry; see Reference 9 
for RW details. 

• Operation — Each RW consists of an inertia wheel, a 
brushless direct current motor, and a tachometer enclosed in 
a sealed housing. A command issued to speed up or slow down 
the wheel speed results in a change in spacecraft angular 
momentum; this occurs because the wheel assembly is rigidly 
fixed in the spacecraft and because the total angular momen- 
tum of the spacecraft plus wheel system has to be conserved 
in the absence of external torques. 

• Parameters and values — These are as follows: 

Parameter Value 

Maximum angular momentum 540 newtons (N)*m»s 

Angular velocity -6000 revolutions per minute 

(rpm) to +6000 rpm 
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• GRO-specific features — These are similar to those 
built for the Space Telescope. Four wheels are arranged in 
a pyramid for redundancy. The location of the RWs is indi- 
cated in Figure 1-5. 

1.2. 1.8 Thrusters 

Thrusters can be used as attitude actuators. The reaction 
forces on the spacecraft caused by the ejection of the gas 
propellant generate the needed torques to maneuver the 
spacecraft. Specifications are as follows: 

• Manufacturer — The orbit adjust thrusters (OATs) are 
made by Hamilton Standard; the attitude control thrusters 
(ACTs) are made by TRW. 

• Operation — The propulsion system consists of four 
OATs for orbit transfer and attitude maneuvers and four 
pairs of ACTs for attitude maneuvers only. The OATs are 
fired simultaneously for orbit transfer. They are fired in 
an off-modulation mode for attitude maneuvers during orbit 
transfer. The ACTs are ope-rated in pairs to produce control 
torques along the desired axis. 

• Parameters and values — These are as follows: 

Parameter Value 


OATs 

Effective distance from space- 
craft center line (moment arm) 

Thrust level 


Thrust level uncertainty 
( imbalance) 

ACTs 

Effective distances from 
spacecraft center line 
(moment arm) 


33 centimeters (cm) each 


444.8 N (100 pound- 
force ( lbf ) ) (BOL) 
155.7 N (35 lbf) (end 
of life (EOL)) 

5 percent (3c) 


TBD 
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Parameter 


Value 


Thrust level 
Thruster misalignment 
Center-of-gravity offset 
Disturbance torques by OATs 


22.2 N (5 lbf ) (BOL), 

8.9 N (2 lbf) (EOL) 

1 deg (3o) in X- and 
Y-axes 

1.9 cm (3o) on each 
axis 

1-14 N*m 


• GRO-specific features — The location of the OATs and 
ACTs is indicated in Figure 1-6. 

1.2.2 MODES OF OPERATION 


All ACAD control modes/ conditions/ and automatic sequences 
will be subject to override by command, even in the presence 
of a single failure. 


OBC-controlled modes requiring thruster firings include a 
commandable thruster drive inhibit capability by which all 
normal control law operations are performed and telemetered 
but no actuation signals are applied to the thruster valves. 

The ACAD provides capabilities .for operating in the control 
modes defined below. Equipment usage is as given in 
Table 1-1, and allowable transitions are as shown in Fig- 
ure 1-7. 


1.2. 2.1 Standby Mode 

The standby mode places attitude control torquers in a 
quiescent state. The entry to and exit from the standby 
mode will be by external command. The capability for op- 
erating the motor drive electronics (MDE) is provided. 

While in the standby mode, the ACAD will accept and process 
commands for execution upon transfer to other modes. Com- 
mand storage capability will be provided for the modes con- 
trolled by the ACAD electronics. 
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Table 1-1. ACAD Modes and Equipment Usage 
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Figure 1—7 . ACAD Control Mode Transitions 
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1.2. 2. 2 Normal Pointing Mode 

The normal pointing mode allows the GRO to be held in any 
desired orientation, using attitude error data provided by a 
stellar/inertial attitude reference. Attitude stabilization 
and control are accomplished by reaction torques produced by 
a set of four reaction wheels. Transfers to and from the 
normal pointing mode will be by external command only, ex- 
cept in the case of a detected anomaly, in which case a 
transfer to either the Sun-referenced pointing or the safe- 
hold modes will take place automatically. Wheel momentum 
unloading is accomplished by using magnetic torquers operat- 
ing in a closed— loop control configuration with Earth mag- 
netic field data provided by TAMs . 

While in the normal pointing mode, the solar array position 
is adjustable as required by external command. 

High-gain antenna pointing can be controlled by either ACAD 
subsystem or external commands. HGA pointing commands are 
derived in the OBC by using GRO and TDRS ephemerides com- 
puted on board with the use of data provided regularly by 
ground command. 

1.2. 2. 3 Normal Maneuver Mode 

Attitude maneuvers at rates within the capability of the GRO 
reaction wheel system are performed in the normal maneuver 
mode. The attitude control laws used in this mode minimize 
excitations of flexible modes. Transfers to and from the 
normal maneuver mode will be external command only, except 
in the case of a detected anomaly, in which case transfers 
to either the Sun-referenced pointing or the safe-hold modes 
will be made automatically. 

Attitude information will be provided by the IRU without 
stellar updates, and control torques will be developed by 
the reaction wheels. TAM measurements will provide data 

1-23 


5132 



to telemetry for post facto attitude determination on the 
ground. 


1.2. 2. 4 Sun-Referenced Pointing Mode 

The main objective of the Sun-referenced pointing mode is to 
allow the GRO +X axis to be pointed at the Sun by using at- 
titude error data supplied by the coarse and fine Sun sen- 
sors and control torques developed by the reaction wheels. 
Momentum unloading is accomplished as described in Sec- 
tion 1.2. 2. 2 for the normal pointing mode. Operation in the 
Sun-referenced pointing mode will be initiated by external 
command or by the occurrence of a detected anomaly. Mode 
termination will be by external command or by the occur- 
rence of a detected anomaly that requires a transfer to the 
safe-hold mode. 

Transfer to the Sun-referenced pointing mode automatically 
initiates an attitude hold condition in which the GRO atti- 
tude is stabilized by reaction wheels, using rate informa- 
tion provided by the IRU. During this attitude hold 
condition, the solar array will be slewed to a preselected 
index position. Upon completion of the solar array slew, a 
Sun acquisition will be initiated automatically. 

The control and steering laws for the Sun-referenced point- 
ing mode are mechanized in the ACE. In the absence of valid 
IRU rate data, the control laws have provisions to operate 
with a derived rate. 

Stabilization about the X-axis is accomplished by using re- 
action wheel torques and attitude data derived from IRU 
measurements. The capability is provided for inducing an 
adjustable rotation rate about the X-axis that will be used 
for star identification on the ground and for star acquisi- 
tion. 
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1.2.2. 5 Safe-Hold Mode 


The primary objectives of the safe-hold mode are to place 
GRO in Sun-referenced pointing orientation and to position 
the solar arrays for maximum power in the event of detected 
anomaly. The safe— hold mode will be initiated by external 
command or by the occurrence of a detected anomaly. The 
mode will be terminated by external command only. Transfer 
to the safe-hold mode automatically initiates an attitude 
hold condition in which the attitude of the observatory is 
stabilized by means of thrusters operating with rate infor- 
mation provided by the IRU. During this attitude hold con- 
dition, the solar array will be slewed to a preselected 
index position. Upon completion of the solar array slew 
maneuver, a Sun acquisition will be performed by means of 
ACTs, using attitude data obtained from the coarse and fine 
Sun sensors and rate information provided by the IRU. 

Provisions are made for holding attitude automatically dur- 
ing Sun eclipse and by external command at any time. 

Control laws for the safe-hold mode will be implemented in 
the ACE. In the absence of valid IRU rate data, the control 
laws have provisions for operating with a derived rate. 

1.2.2. 6 Thruster Maneuver Mode 

Attitude maneuvers at rates that exceed reaction wheel mo- 
mentum storage capabilities can be executed in the thruster 
maneuver mode. Control torques are provided by the ACTs, 
and attitude data are derived from IRU information. Control 
laws are implemented in the OBC. The thruster maneuver mode 
will be initiated and terminated by ground command except on 
detection of a confirmed anomaly, which will cause a direct 
transfer to either the Sun-referenced pointing or the safe- 
hold modes. While in the thruster maneuver mode, the momen- 
tum unloading function is disabled. Magnetometer data will 
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be telemetered for post facto attitude determination on the 
ground . 

1*2. 2. 7 Velocit y Control Mode 

The velocity control mode will be used to execute velocity 
correction maneuvers and to control the attitude of GRO dur- 
ing these maneuvers. In the velocity control mode, the ACADS 
controls the firings of the velocity control thrusters to 
produce the required firing durations and to control GRO 
attitude about the pitch and roll axes by off modulation. 

The ACTs are used to control the attitude about the yaw 
axis. Firing durations are selectable by external command. 

required initial orientations for velocity correction 
maneuvers are attainable by means of either the normal or 
the thruster maneuver modes. Means are provided to automat- 
ically rotate the GRO Z-axis for maintaining the thrust vec- 
tor along the orbit velocity direction. Attitude error 
information is provided by the IRU, operating without celes- 
tial updates. Magnetometer data will be telemetered for 
ground attitude determination. Control laws are implemented 
in the OBC. The velocity control mode will be initiated and 
terminated by external command only, except in the event of 
a detected OBC failure or other selected abnormal observa- 
tory conditions, which will cause automatic turnoff of the 
AV thrusters and a transfer to either the Sun-referenced 
pointing or the safe-hold modes. 

1 . 2 . 2 . 8 Thruster Command Mode* 

The thruster command mode allows any selected low-level 
thruster to be fired directly, in real time, by external 
commands. The firings will be in impulses of fixed dura- 
tion. Two impulse durations are selectable by external 
command. Each command will produce only one impulsive 
firing. Activation of the thruster command mode will be by 
ground command only, by using fault tolerant commands. 
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The control logic for the thruster command mode is mech- 
anized in the ACE, separately from the OBC. 

1.2. 2. 9 Backup Orbit Maintenance Mode 

This mode provide capabilities to orient the observatory and 
to control the propulsion subsystem thrusters with logic 
that is independent of the CADH Subsystem OBCs in such a 
manner that the GRO orbit can be maintained for a period of 
up to 3 months. 

Attitude maneuvers for attaining the orientation required 
for AV firings will be made with control torques provided 
by the low-level thrusters and attitude data provided by the 
IRU. 

Velocity increments will be attained by firing either one of 
the available pairs of AV thrusters. Three-axis attitude 
control during AV firings will be provided by the low- 
level thrusters. 

1.3 DYNAMICS SIMULATOR OVERVIEW 

The purpose of the GRO Dynamics Simulator is to test and 
evaluate GRO flight software under conditions that simulate 
the expected in-flight environment as closely as possible. 

The complete simulator system, shown in Figure 1-8, consists 
of five logical subsystems (which may or may not correspond 
to separate programs when developed) : 

• Profile 

• Simulation Control and Input/Output (SCIO) Subsystem 

• Truth Model 

• OBC Model 

• Postprocessor 
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Figure 1-8. GRO Dynamics Simulator Data Flow 








The Profile Subsystem will generate the environmental torque 
profile for GRO. In addition, it will generate the space- 
craft, solar, and lunar ephemerides; the Earth's magnetic 
field vector; time-varying moments of inertia; and star 
position vectors. The Profile Subsystem is discussed in 
detail in Section 2. 

The SCIO Subsystem will be the executive driver for the 
simulator. It will accept user input, initialize param- 
eters, control simulation, and generate output data files 
and a simulation status display. The SCIO Subsystem is dis- 
cussed in detail in Section 3. 

The Truth Model Subsystem uses the ephemerides, magnetic 
field, star position vectors, and disturbance torque infor- 
mation supplied by the Profile Subsystem and the control 
torques to obtain the current spacecraft state and sensor 
measurements to simulate the response of the attitude hard- 
ware. The Truth Model Subsystem is discussed in detail in 
Section 4. 

The OBC Model Subsystem uses sensor data provided by the 
Truth Model, a Kalman filter for attitude determination, and 
control laws to compute attitude control commands that are 
provided as input to the Truth Model. The OBC Model Subsys- 
tem is discussed in detail in Section 5. The attitude 
control electronics (ACE), which is implemented as part of 
the OBC Subsystem, is discussed in Section 6. 
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SECTION 2 - PROFILE SUBSYSTEM 


The Profile Subsystem for GRO will calculate the external 
environmental torque profile for the spacecraft on the bases 
of a normal orbit and attitude/ mass properties data, and 
geometric configuration. The environmental torques modeled 
will include aerodynamic, solar pressure, gravity-gradient, 
and residual magnetic dipole torques. The program will also 
generate spacecraft and solar ephemerides. Earth's magnetic 
field vector, and star position vectors. 


2.1 REQUIREMENTS 

2.1.1 PROCESSING REQUIREMENTS 

Rl.1.1 Calculate external environmental torque profile 

for GRO on the bases of a nominal orbit and atti- 
tude, mass properties data, and geometric con- 
figuration. 

Rl.1.2 Model environmental torques, including gravity- 
gradient, aerodynamic, solar pressure, and 
residual magnetic dipole torques. 


Rl.1.3 


Rl.1.4 


Rl.1.5 


Generate spacecraft, solar, lunar, and TDRS 
ephemerides and the Earth's magnetic field vector. 

Compute the angular momentum contributed by the 
rotation of the solar arrays and TDRS antenna. 

Calculate apparent spacecraf t-to-star unit vector 
for each star in the FHST fields of view. 


Rl.1.6 Provide the following three methods of calculat- 

ing the initial attitude: 

• Using the calculated Sun vector and input 
coordinates of a point on the celestial 
sphere 
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• Using input coordinates of the body X-axis 
and the target point 

• Using the input attitude quaternion 

Rl.1.7 Model a nominal maneuver. 


Rl.1.8 Model TDRS tracking by the high-gain antenna. 

Rl.1.9 Perform all internal computations in the mks sys- 
tem of units and express all angular quantities 
in radians 


Rl.1.10 

Rl.1.11 

Rl.1.12 

Rl.1.13 
Rl.1.14 
2 . 1.2 
R1.2. 1 


Use only righthanded orthogonal coordinate systems 

Compute the time varying inertia properties due 
to movement of the HGA and solar arrays 

Compute the orientation angles (separately) for 
the solar arrays 

Compute the pointing angles for the HGA 
Compute spacecraft velocity 
INPUT REQUIREMENTS 

The Profile Subsystem will provide defaults for 
all user input parameters. 


Rl.2.2 The Profile Subsystem will support interactive 
user modification or input of the following in- 
formation: 


• Start and stop times of the run 

• Interval stepsize 

• Magnetic field parameters (order of field, 
constant magnetic field bias, and residual 
magnetic dipole bias) 

• Epoch time and initial Keplerian orbital 
elements 
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• Options for generating Sun, Moon, TDRS, and 
spacecraft ephemerides 

• Star tracker parameters, target star cri- 
teria, and star catalog 

• Debug option 

• Parameters to describe a maneuver 

• Order of magnetic field model 

• Components of moment of inertia tensor 

• Drag coefficients (other than default) 

Rl.2.3 The Profile Subsystem will not support user to 

input or modification of the following permanent 
information that relates to the satellite geom- 
etry: 

• Number and types of elements in satellite 
decomposition 

• Area of individual spacecraft element 

• Normal-to-spacecraf t surface vectors 

• Solar radiation pressure and aerodynamic 
torque constants 

• Vector from spacecraft center of mass to 
center of pressure for each element 

• Solar radiation pressure values 

• Aberration coefficients 
2.1.3 OUTPUT REQUIREMENTS 

Rl.3.1 The Profile Subsystem will output the following 

information at a user-specified interval in a 
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form that can be input to the Truth Model Subsys- 
tem portion of the simulator: 

• Start time and stop time 

• Number of records 

• Current time 

• Earth’s magnetic field 

• Unit vector from spacecraft to Sun 

• Vectors from spacecraft to Earth and Moon 

• HGA drive (HGAD) pointing angles (one pair 
of angles for each TDRS) 

• Velocity vector 

• Individual external torque vectors 

• Components of moment of inertia tensor 

• Aerodynamic drag coefficient 

• Star unit vectors 

• TDRS Fourier coefficients 

• Spacecraft center of mass 

R1 .3.1.1 The output data types (R*8, R*4, etc.) should 

remain the same as in the existing ERBS Profile 
Program (Reference 10) . 

Rl.3.1.2 All output should be in the meter-kilogram-second 
(mks) system of units, with all angular quanti- 
ties in radians. 

Rl.3.2 The Profile Subsystem will print a profile ini- 

tialization report containing the following in- 
formation : 

• Start and end times 

• Interval stepsize 
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• Magnetic field variables 

• Input orbital elements 

• Methods for generating solar, lunar, TDRS, 

and spacecraft ephemerides 

R1 . 3 . 3 The Profile subsystem will provide printed output 

at each time step that contains the following 
information: 

• Current time 

• Earth magnetic field 

• Unit vector from spacecraft to Sun 

• Vectors from spacecraft to Earth and Moon 

• Velocity vector 

• Total torque vector 

• Components of moment of inertia tensor 

• Individual torque vectors 

• Star unit vectors 

2.2 MATHEMATICAL SPECIFICATIONS 

2.2.1 INITIALIZATION OF SPACECRAFT ATTITUDE 

Since the spacecraft is to remain inertially fixed in space 
for at least 14 days, the attitude matrix [A] will remain 
fixed for a simulator run unless a maneuver is executed (see 
later discussion) . Provision should be made to initialize 
the attitude in any one of the following three ways: 

1. Input the coordinates of the point on the celestial 
sphere, right ascension and declination, and gen- 
erate an attitude matrix consistent with Sun- 
spacecraft constraints. 

a. For epoch time, obtain the Sun vector, R g , 

in geocentric Cartesian inertial coordinates, 
as described in Section 2.2.2. 1. 

A 

b. Form the Sun unit vector, R g . 
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c. Generate the attitude matrix [A] such that 

I i 

= [X I Y I Z] (2-1) 

I I 

where Z = [Z x , Z y/ Z z ] is the spacecraft body 
Z-axis, which is the scientific instrument ob- 
serving direction, and is therefore given by 

Z = [cos 5 cos a, cos 6 sin a, sin 5] T (2-2) 

and 


[A] = 


*X *Y 




Y Y 
X Y X Z 


Y = (Z x Rg)/ | Z x R g | (2-3) 

/X /\ /N 

X = Y x Z (2-4) 


This method puts the body X-axis in the 
spacecraft-Sun-target point plane. 

2. Input the right ascension and declination of both 

the body X-axis and the target point. Generate the 
attitude matrix as 

A | A I A 

[A] = [X ( Y , Z] 


where 

Z = [cos 5 t cos a T , cos 6 T sin a T , sin 6 T ] (2-5) 
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( 2 - 6 ) 


X = [cos S x cos a x , cos 6 X sin a x , sin 6 X ] 

Y = Z x X (2-7) 

3. Input the attitude quaternion, q. Generate the 
attitude matrix as in the utility EULERC (Refer- 
ence 10) : 



2 2 2 2 
q x - q 2 - q 3 + q 4 

2(q l q 2 + q 3 q 4> 

2 < q l q 3 

- q 2 q 4> 

[A] > 

2(q l q 2 “ q 3 q 4> 

2 2 2 2 
- q l + q 2 ~ q 3 + q 4 

2 < < 3 2 q 3 

♦ q l q 4> 


2< q i q 3 + q 2 q 4 > 

2(q 2 q 3 - qjq 4 ) 

2 2 
- q i - q 2 

* 4 * 


2.2.2 EPHEMERIDES AND ABERRATION 

2 . 2 . 2 . 1 Spacecraft. Solar, and Lunar Ephemerides 

The spacecraft, solar, and lunar ephemerides are obtained by 
a call to a FORTRAN ephemeris package, EPHEMS. EPHEMS is a 
modified version of subroutine EPHEMX, which is described in 
Reference 11). Options for obtaining spacecraft, solar, and 
lunar ephemerides have been modified. All subroutines ref- 
erenced, except subroutine FASTOX, are documented in Refer- 
ence 11. FASTOX is described in Reference 12 and in 
Appendix C. 

The subroutines available for obtaining the GRO and TDRS 
spacecraft position and velocity are 

1. FASTOX (Earth orbit) 

2. DTAPRE (Earth orbit) (entry point of ROITAP) 

The subroutine for obtaining the solar and/or lunar ephem- 
eris is SMPOS. SMPOS is described in Reference 11 and Ap- 
pendix C. 
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2. 2. 2. 2 Star Ephemeris 

The star ephemeris will not originate in the Profile Pro- 
gram. The star data to be used will be obtained from a 
subset of the star catalog generated by the SKYMAP Program. 

The star coordinates will be converted to a unit vector in 
geocentric inertial (GCI) coordinates by 

'f 

STAR = [cos 6 cos a, cos 5 sin a, sin 6] (2-11) 

where l^TAI* is the unit vector from the spacecraft to the 
star in GCI coordinates, and a and 6 are the celestial 
coordinates for the star. 

2. 2. 2. 3 Aberration 

During the time that light travels from the Sun or a star to 
the spacecraft, the position of the Sun or star relative to 
the spacecraft changes. Therefore, the Sun or star posi- 
tion, as viewed from the spacecraft, is not the true Sun or 
star position. Since the Sun and star positions provided to 
the Profile Subsystem are the true positions, they should be 
corrupted by aberration effects. 

The apparent position of the Sun and stars is computed as 
follows : 


p Q + (V E /c) + (V R /c) 
|y Q + (V E /c) + (V s /c)| 


( 2 - 12 ) 


where p is the apparent unit position vector of the Sun or 

star in GCI coordinates, p Q is the true unit position vector 

of the Sun or stars in GCI coordinates (from ephemeris), 

V is the Earth velocity vector in GCI coordinates, V is 
-E. s 

the spacecraft velocity vector in GCI coordinates, and c is 
the speed of light. 
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The unit vector in the direction of the Earth velocity vec- 
tor is given by 



R x W 
\~R x W | 


(2-13) 


where R is the Earth-to-Sun vector in GCI coordinates (from 
ephemeris) and W is the ecliptic north pole (in GCI coordi- 
nates) . 

The spacecraft velocity vector, V , is obtained from the 

s 

ephemeris routines identified in Section 2. 2. 2.1. 

2.2.3 MAGNETIC FIELD 

The magnetic field is modeled by an eighth-order spherical 
harmonic expansion, the International Geomagnetic Reference 
Field (IGRF). (See Appendix H of Reference 11.) This ex- 
pansion is computed by subroutine MAGFLD (Reference 10). 

2.2.4 ANGULAR MOMENTUM OF INTERNAL MOTION COMPUTATION 

The coordinates of the center of mass (CM) of the spacecraft 
components (main body, solar array, and antenna) are re- 
quired for computing the component inertia tensors, which in 
turn are required for determining the angular momentum at- 
tributable to internal motions and the gravity-gradient 
torque . 

For Sections 2.2.4. 1 and 2. 2. 4. 2 let 

Bj represent spacecraft component j, j = 0 (main 
body) , 1 , 2 , 3 

R c = CM of the total system with respect to the 

origin of the body coordinate system BCS (OBCS) 

'rj(t) = CM of Bj with respect to OBCS 

“p". = CM of B. with respect to R 
3 t 

hj = hinge point of Bj with respect to OBCS 

m. = mass of B. 

3 3 
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Wj = angular velocity vector of in inertial space 
Wj = angular velocity vector of Bj with respect to B Q 
(j = 1, 2, 3; “Uj = oTq + Wj) 

2. 2. 4.1 Solar Arrays and Hiah-Gain Antenna Angular Rates 

The high-gain antenna angular rates, a, are obtained from 
the high-gain antenna module, where they are computed as 
indicated in Section 2.2.7. 

Let 


R SB = ^ R S 


and 


a 


tan 


-1 


r sb/ r s b x 


(2-14) 


where a is the angular displacement of the solar array 
normal from the X-Y body coordinate plane, which is limited 
to the range -90° < a < 90° and is positive toward the body 
Z-axis. The angular rate is then computed by 

a = (ct c - a p )/At (2-15) 

where subscripts c and p indicate current and previous 
values. If |a| > o^, then a = with proper sign and is 
TBD, where is the maximum solar array angular rate. 

TRW is considering plans to fix the solar arrays at a par- 
ticular cant angle and hold it fixed for each view period. 
Provision should therefore be made to input a specific angle 
and a flag used to bypass the computation of the cant angle 
and set its angular rate, a, to zero. 
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2. 2. 4. 2 Center of Mass 


The CM of B j 


is given by 


^j(t) = c. T (T.( t 0 ) -h.) + ~h. (2-16) 

where j = 0, 1, 2, 3; [C Q ] = I (unit matrix); and [C^ , 

[C„], and [C_] represent the transformation matrices for the 
antenna and two solar arrays, respectively. 

Then 


and 



(2-17) 



(2-18) 


2. 2. 4. 3 Moment of Inertia 

The total moment of inertia (MOI) tensor of the spacecraft, 
[I T ], relative to axes parallel to the BCS frame and 
passing through it, is given by 


3 

CI T ] = ^ tJ j ] (2-19) 

j=0 
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where 


tJ i 3 ■ 


C 3 


[Jj] tc 


j 3 * ra j ”> - v*i) 


( 2 - 20 ) 


where [J^] is the MOI tensor of B.. in the BCS frame but rela- 
tive to the CM of Bj , and 'p’jO ~pT is an outer product. 

2. 2. 4. 4 Angular Momentum of Internal Mot-inn 

The angular momentum contributed by the solar array panels 
and the TDRS antenna is given by 


'INT " <[Jj] + [Kj]) wj 

j=l 


( 2 - 21 ) 


where 


[ V ■ -j 


Pj * <R C ■ h j> tn - <* c - "hj)o "pT 


( 2 - 22 ) 


Hence, Equations (2-20) and (2-22) can be substituted into 
Equation (2-21) to obtain 


'INT “ 

j = l 


[Cj ] [ Jj ] [Cj ] + m.. 


[ T : * (7 3 

- V oT l] 

where L INT is internal angular momentum. 


+ R - 


h.) [I] 


- (Pj + R c 


(2-23) 


W j 
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2.2.5 EXTERNAL TORQUE COMPUTATIONS 
2. 2. 5.1 Aerodynamic Torque Model 

The atmospheric density for a given time and spacecraft 
position is computed by using the Jacchia model described in 
Reference 13. The values for the 10.7-centimeter (cm) flux 
and the geomagnetic index used in the Profile Subsystem are 
from the 95 percentile range of the Marshall Space Flight 
Center (MSFC) tables dated October 25, 1977. 

The aerodynamic pressure, QOC, is computed from the follow- 
ing equation: 

QOC = “ (RHO) (VMAG 2 ) (2-24) 

where RHO is the atmospheric density at the current space- 
craft position and VMAG is the magnitude of the spacecraft 
velocity from the spacecraft ephemeris. 

To simplify the calculation of the solar and aerodynamic 
torques, the spacecraft is modeled as an assembly of cyl- 
inders, flat plates, and spheres. For each of the compo- 
nents, a surface unit normal vector and moment arm is 
needed. The unit normal for a flat plate is the vector per- 
pendicular to the surface. The unit normal for a cylinder 
is the cylinder’s axis of symmetry. A sphere has no unit 
normal. For a cylinder, the area entered is the cylinder 
height times the diameter. For a sphere or flat plate, the 
area entered is its surface area. The unit normal of each 
component is computed in the Profile Program if the compo- 
nent is Sun pointing or anti-Sun pointing. Earth pointing or 
anti-Earth pointing. This is done by picking up the 
spacecraf t-to-Sun and spacecraf t-to-Earth vectors from the 
ephemeris modules. If the component is rigidly fixed to the 
body, the unit normal in the spacecraft frame of reference 
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is input to the program. For the GRO mission, the latter 
option is used. The GRO spacecraft body model is described 
in Appendix B. Shadowing by the solar panels is not ad- 
dressed. 

The next step is to compute the angle of attack and pro- 
jected area for each component. The angle of attack is de- 
fined as the angle between the wind vector and the unit 
normal vector. 


ANGATK = COS 1 [-(ANV • WINb) ] (2-25) 

where ANGATK is the angle of attack, ANV is the unit normal 
of a flat plate in spacecraft coordinates or the unit vector 
along a cylinder axis in spacecraft coordinates, and WIND is 
the unit vector of the wind in spacecraft coordinates. This 
is the negative of the spacecraft velocity unit vector. 

For a sphere, the angle of attack is assumed to be zero. 

If the magnitude of the angle of attack is greater than 
90 deg for a flat plate, the torque contribution for that 
element is set to zero. 

The projected area is defined as the surface area the wind 
is hitting. For a sphere, the angle of attack has no mean- 
ing, and the projected area is calculated as 

PAREA = AREA/4 (2-26) 

For a cylinder, the projected area is 

PAREA = (AREA) sin (ANGATK) (2-27) 
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For a flat plate, the projected area is 

PAREA = (AREA) COS (ANGATK) (2-28) 

where PAREA is the projected area and AREA is the compo- 
nent's area (input). The aerodynamic force along WIND is 

Force = (CD) (QOC) (PAREA) (2-29) 

where CD is the aerodynamic drag coefficient (an input con- 
stant) (Reference 11, Section 17.2.3). 

The torque on the spacecraft from each component is computed 
from 


T = R x F 


(2-30) 


where IT is the vector to component in body coordinates (in- 
put) and iT is the force vector (= FORCE WINE)) . 


To compute the total aerodynamic torque, the torque for each 
component is added vectorally. 


2. 2. 5. 2 Solar Pressure Torque Model 

Before the solar pressure torque is computed, a check is 
performed to see if the spacecraft is in the Earth’s 
shadow. This is done as follows: 


SHADOW = (R • 1?SUN) - ll - (R e /SCTE) 2 J (2-31) 

where R is the spacecraf t-to-Earth unit vector (GCI coordi- 
nates), PSUN is the spacecraf t-to-Sun unit vector (GCI coor- 
dinates), R g is the radius of the Earth (km), and SCTE is 
the spacecraf t-to-Earth vector (km GCI) . 
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If SHADOW is greater than zero, the spacecraft is in shadow 
and no solar pressure torque is computed. If it is less 
than zero, the spacecraft is in Sun, and the solar pressure 
torque is computed. 

The model of the spacecraft as an assembly of simple geo- 
metric shapes, as described in the computation of the aero- 
dynamic torque (Section 2. 2. 5.1), is also used to compute 
the solar pressure torque. First, the angle of attack is 
computed : 


0 = SOLCOS = COS 1 (ANV • SUN) 


(2-32) 


where SOLCOS is the angle of attack, ANV is the unit normal 
of a flat plate in spacecraft coordinates or the unit vector 
along a cylinder axis in spacecraft coordinates, and SUN is 
the unit vector from the spacecraft to the Sun in spacecraft 
coordinates . 


For a sphere, the angle of attack is assumed to be zero. If 
the magnitude of the angle of attack for a flat plate is 
greater than 90 deg, the torque contribution for that ele- 
ment is set to zero. 


Next, the solar radiation force is computed. For a flat 
plate, it is calculated as follows (Reference 11) : 


F 


(-SOLC1) (COS 6) (AREA) {(1 - SOLC2 ) SUN 
+ 2 [ ( SOLC2 COS 6) + SOLC3] ANV} 


(2-33) 


where SOLC1 is the solar radiation pressure, AREA is the 
flat plate’s surface area (input value), SOLC2 is the coef- 
ficient of specular reflection, SUN is previously defined, 
and SOLC3 is one-third the coefficient of diffuse reflection. 


5132 


2-16 



For a cylinder, the solar radiation force is computed by the 
following : 


T = (-SOLC1) (AREA) 


1 ♦ sin 9 ♦ f 


] 


SOLC3 SUN 


- cos 6 ( | S0LC2 sin 9 + | S0LC3) ANV 


(2-34) 


For a sphere, it is computed as follows: 

1 + SOLCl j (2-35) 

The torque on the spacecraft from each component is 

T* = R~ x F (2-36) 

where 1* is the vector to component in body coordinates (in- 
put) . The torque for each component is added vectorially to 
obtain the total solar pressure torque. 

2. 2. 5. 3 Gravity-Gradient Torque 

The gravity-gradient torque is computed from the following 
equation (Reference 11) : 


~F = (-SOLC1) (AREA) 


T = 


_ 2U 


R 


3 ( *s X 


[I] 


R ) 
s' 


(2-37) 


where p is the Earth’s gravitational constant (3.986005 x 

10^" 4 cubic meters per squared second), R g is the Earth-to- 

spacecraft distance, [I] is the spacecraft moment of inertia 

tensor, and R is the unit vector from Earth to spacecraft 
s 

in BCS coordinates. 
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2. 2. 5. 4 Residual Dipole Magnetic Torque 

The torque on the spacecraft due to a residual dipole is 

T = m x [A] 13 (2-38) 

where rn is the residual dipole in BCS coordinates (an input 
value), [A] is the rotation matrix from GCI to BCS coordi- 
nates (see Section 2.2.1 for the method of computing [A]), 
and B is the magnetic field vector in GCI coordinates from 
the magnetic field model (Section 2.2.3). 

2. 2. 5. 5 Resultant External Torque 

The individual external torques are included in the output 
records of the Profile Subsystem to facilitate their inclu- 
sion or exclusion in the truth model if the option is exer- 
cised to compute some of them by using the actual spacecraft 
attitude instead of a nominal orientation. 

2.2.6 MANEUVER SIMULATION 

A nominal maneuver is modeled in the Profile Subsystem to 
provide a continuous definition of environmental torques 
°ver the interval of the maneuver. Being nominal, it does 
not represent the actual irregular motions of the spacecraft 
about its axes. Nor will it represent the overshoot and 
oscillations as the spacecraft settles in its new orienta- 
tion. Nevertheless, it should provide a better representa- 
tion than if it were omitted. 

TRW, the prime contractor, currently plans to maneuver the 
spacecraft to effect an attitude change by a single Euler 
axis rotation, that is, by simultaneous rotations about each 
body axis. 

To model the maneuver, the start time, t , and the end 

s 

time, t e , of the maneuver are required, as is the specifi- 
cation of the old and new spacecraft orientations, expressed 

2-18 


5132 



as quaternions q Q and q n , respectively. The quaternion q fc 
that will map q Q to q n is obtained from 


q t = q n * q o _1 


-1 


where * denotes quaternion multiplication and q Q is the 
conjugate with q^. in the form 


(2-39) 


which is expanded to the form 


q t = 


. § 

sin 2 

. 6 
<x 2 sin 2 

. a 

a 3 sin 2 


cos 


S 


(2-40) 


wi 


th e = 2 COS 1 q A , if |qj <0.707 and 


9 = sin * 1 - q\ 


if |q 4 | > 0.707, for better accuracy; and 


a k = _ “fi 
sin f 


k = 1, 2, 3 
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where a^, a 2 , define the Euler axis and © the angle of 
positive rotation about that axis. Consider two cases: 

Ca s e 1 

By default, it will be assumed that a simulated maneuver 
will be by the shortest positive rotation about the axis, 
i.e., 0 < 9 < 180. If q^ < 0, (cos 0/2 < 0) indicating 9 > 
180, the negative of q fc is used, forcing © < 180 and 
switching the positive direction of the Euler axis. 

A flag will be used to simulate a rotation greater than 
180 deg (and less than 360 deg). Therefore, the negative of 
q fc will be used if q 4 > 0 to force 0 > 180 and to switch the 
positive direction of the Euler axis. 

The angular rate, w, is then obtained by 



where T = t Q - t . 

U s 

Then the uniform angle of increment per time increment is 

9. = wAt 
A 

and At TBD with respect to total maneuver distance and 
time T. By default. At will equal 2 min but is left as a 
user option. 
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This then determines the quaternion at each At, i.e.. 


Aq = 



sin y 

. e < 

a .2 sin y 

. 6 t 
sm y 


e, 


cos 


(2-41) 


Thus, the quaternion characterizing a slew about the Euler 
axis from q Q to q n at increments of time = At are defined 


q 1 = Aq * q Q 

q 2 = Aq * q ± = (Aq ) 2 * q Q 
q 3 = (Ai ) 3 * q Q 


q n = (Aq) n * q Q 

2.2.7 HIGH-GAIN ANTENNA 

The high-gain antenna is used for tracking and communication 
purposes through the TDRS . The GRO software simulator is to 
be capable of tracking (pointing to) one of two TDRSs (east 
or west), switching on alternate passes. The angles defin- 
ing antenna orientation are azimuth and elevation angles in 
the antenna coordinate system (ACS) (see Appendix A) . The 
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antenna is capable of moving at a tracking rate of 0.06 deg/ 

sec and at a slew rate of 2.81 deg/sec. Input requirements 

are specifications of which TDRS is to be tracked first and 

whether switching is to be done on successive orbits, as 

well as unit vectors to the TDRSs , T_ and T.., in BCS coor- 

w 

dinates. Also required is the cant angle, a, between the 
body X-axis and the boom, as well as the spacecraft alti- 
tude, h, and a unit vector to the Earth, R_. 

£ 

Calculations are as follows: 


1. Check for TDRS visibility. If 9 > 0 E , TDRS is 
visible where 9 = R £ • T\ and T^ = T £ or T w and 9 £ = 

71.44 deg - 0.0244 (h - 350 km). 

2. If TDRS is visible, transform its unit vector to 
ACS, as follows: 


$ iA - [R] T t 


(2-42) 


where 


[R] = 


-sm a 
0 

cos a 


0 

1 

0 


-cos a 
0 

sin a 


(2-43) 


3. Compute observations, as follows: 


a = tan 1 [T. Y /(-T. x )] 


(2-44) 


e = cos 1 (T iz ) 


(2-45) 


Azimuth is measured positive from the -X axis (ACS) going 
toward the +Y axis (ACS), and is bounded by mechanical 
gimbal stops to -200 < a < 200 deg. Elevation is measured 
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positive from the +Z axis (ACS) going toward the -X axis 
(ACS) for an azimuth of 0, and is bounded -by mechanical 
stops to -110 < e < 110 deg. In computing the pointing 
angles , use the antenna tracking rates and the respective 
gimbal limits. 

4. If the current TDRS is occulted by the Earth and if 
switching is to be done, proceed as in item 2, but with the 
other TDRS unit vector, and use the antenna slewing rates. 
Antenna slewing to acquire a new TDRS should thus occur when 
the spacecraft is occulted by the Earth from the previous 
TDRS. 

5. The antenna angular rates are computed as follows: 

a = (a c - a p )/At (2-46) 

4 = (e„ - e )/At (2-47) 

c p 

If | a | > a M , a = a M with proper sign. If |e| > e M , e = e M 
with proper sign. Subscripts c and p indicate current and 
previous values. At is the computing interval, and sub- 
script M indicates the maximum rate for the tracking mode of 
the antenna. 
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SECTION 3 - SIMULATION CONTROL AND I /O SUBSYSTEM 


The SCIO Subsystem for GRO will control the execution of the 
Truth Model and the OBC Model during simulation. The SCIO 
Subsystem will also be responsible for handling all communi- 
cations with the user during simulation and will perform the 
following major functions: 

• initialize simulation parameters and allow the user 
to interactively set user input parameters and to 
input a ground command schedule 

• Control simulation on the basis of a cycle time 
equal to the real-time cycle time and allow the 
user the option of inputting an overriding cycle 
time 

• Send ground commands to the OBC Model on the basis 
of a command schedule 

• Output analysis data generated by the Truth Model 
and the OBC Model during each simulation cycle 

3.1 REQUIREMENTS 

3.1.1 PROCESSING REQUIREMENTS 

R2.1.1 The SCIO Subsystem will control interaction and 

communication between the Truth Model, the OBC 
Model, and the user during simulation. 

R2.1.2 The SCIO Subsystem will control the execution of 

the Truth Model and the OBC Model on the basis of 
the real-time cycle time or a user-specified 
cycle time. One pass through the Truth Model and 
OBC Model will be one simulation cycle. 

R2.1.3 The SCIO Subsystem will send a user-specified 

time— ordered set of commands to the OBC Model. 
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R2. 1 


R2.1. 

R2.1. 

R2.1. 

3.1.2 

R2.2. 

R2.2. 

R.2.2 


.4 The SCIO Subsystem will provide the user with the 

following run time options during simulation: 

• Start (restart) simulation 

• Stop simulation 

• Modify user input parameters 

• Interrupt simulation at specified time and 

modify parameters as specified by user at 

run initiation 

4.1 The SCIO Subsystem will interrupt simulation, at 
the direction of the user, only at the end of a 
simulation cycle. 

4.2 The SCIO Subsystem will log all changes to user 
input parameters made during simulation to pro- 
vide traceability. 

5 The SCIO Subsystem will always generate an ini- 
tialization report containing the values of all 
user input parameters at the beginning of every 
simulation. 

INPUT REQUIREMENTS 

1 The SCIO Subsystem will provide defaults for all 
user input parameters. 

2 The SCIO Subsystem will allow the user to inter- 
actively override the defaults for all user input 
parameters . 

■ 3 The SCIO Subsystem will allow the user to op- 
tionally input the following sets of parameters: 

• Sensor parameters 

• Initial conditions and integration parameters 

• Simulation control parameters 


3-2 


5132 



R2.2 


R2.2 


R2.2 

R2.2 

R2.2 

3.1.: 

R2.3 

R2.3 . 


• OBC Model parameters 

• Output control parameters 

.4 The SCIO Subsystem will, at a user-specified time 

and with user-specified values, modify any 
selected subset of the following: 

• Sensor parameters 

• Control parameters 

.5 The SCIO Subsystem will allow the user to inter- 

actively create a set of time-scheduled ground 
commands for the OBC Model. Appendix D contains 
a list of the ground commands accepted by the 
SCIO Subsystem. 

6 Simulations will be repeatable. 

6.1 The SCIO Subsystem will store the user input pa- 

rameters set and command schedule associated with 
each simulation case to allow repeatability. 

6.2 The SCIO Subsystem will allow the user to use a 
prestored set of user input parameters and com- 
mand schedules to initialize simulation. 

OUTPUT REQUIREMENTS 

1 The SCIO Subsystem will output simulation status 

information to the user terminal at a user- 
specified time interval. 

2 The SCIO Subsystem will collect and store output 
data from the Truth Model and the OBC Model dur- 
ing simulation for later analysis after simula- 
tion has completed. These data will contain the 
following information: 

• True state vector 

• Spacecraft position and velocity 

• Sensor status flags and output 

• Time tag 
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• OBC Model status and control voltages 

• OBC Model attitude error 

3.2 MATHEMATICAL SPECIFICATIONS 

To obtain for output display purposes the spacecraft roll, 
pitch, and yaw errors, an Euler rotation sequence of 3-1-2 
has been assumed. To date, no definitive word has been re- 
ceived on this matter. Unless such word is received, the 
following formulation is tentative, and the actual Euler 
rotation sequence should be considered TBD. Given the atti- 
tude matrix, [A], and the spacecraft body rate vector, u“ B , 
the spacecraft roll, pitch, and yaw errors are obtained as 
follows : 


roll error = 4> = sin 


pitch error = © = tan 


yaw error = <|f = tan 


_1 [A 23 ] (3-1) 

[ - A 13 /A 33 ] (3 - 2 > 

[ - A 21 /A 22 ] (3 - 3) 


The spacecraft roll, pitch, and yaw error rates are then 
obtained as follows: 


roll error rate = <J> = to cos 0 + to_ sin 0 (3-4) 

X 6 


pitch error rate = 0 = to^. - to u tan 4> (3-5) 


yaw error rate = y = u u /cos <|> 


(3-6) 


where to is to cos 0 - to sin 0. 

U Z A 
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SECTION 4 - TRUTH MODEL SUBSYSTEM 


The Truth Model Subsystem will use the ephemeris data, ex- 
ternal torques, and magnetic field information as well as 
the current spacecraft state to simulate or encode the re- 
sponse of the attitude hardware. The Truth Model Subsystem 
will communicate with the user through the simulation con- 
trol and I/O portion (Section 3) and will be completely con- 
trolled by the SCIO Subsystem. The Truth Model Subsystem 
will perform the following functions: 

• Decode spacecraft commands from the OBC Model Sub- 
system 

• Effect actuators as commanded by the OBC Model Sub- 
system 

• Update and interpolate the spacecraft ephemeris and 
environmental torques 

• Integrate the spacecraft equations of motion with 
respect to time 

• Generate true data at a specified rate for output 

The derived software requirements and mathematical specifi- 
cations for the Truth Model Subsystem are presented in the 
following sections. 

4.1 REQUIREMENTS 

4.1.1 PROCESSING REQUIREMENTS 

R3.1.1 The Truth Model Subsystem will use profile data 

generated by the Profile Subsystem. 

R3. 1.1.1 The Truth Model Subsystem will interpolate the 
profile data, using a five-point Lagrangian in- 
terpolator when the data intervals are larger 
than the simulation time step (cycle time) . 


5132 


4-1 



R3.1.2 


R3.1.3 


R3.1.4 


R3.1.5 


R3 . 1 . 6 


R3 . 1 . 7 


R3 .1.8 


R3.1.9 

R3.1.10 


R3.1.11 


R3.1.12 


On option, the environmental torque profile will 
be calculated in the Truth Model Subsystem. 

The Truth Model Subsystem will compute torques 
resulting from OBC Model Subsystem commands. 

The Truth Model Subsystem will compute the net 
external torque on the spacecraft. 

The Truth Model Subsystem will integrate the 
spacecraft attitude equations of motion by using 
a fifth-order, variable-step Adams-Moulton- 
Bashforth (AMB) predictor-corrector. 

The Truth Model Subsystem will model the attitude 
sensors to provide realistic sensor data for in- 
put to the OBC Model Subsystem. 

The Truth Model Subsystem will prepare true data 
for standard output. 

The Truth Model Subsystem will operate under the 
control of the SCIO Subsystem. 

In the Truth Model Subsystem, all coordinate 
systems will be right-handed orthogonal systems. 

The Truth Model Subsystem will perform all in- 
ternal computations in the mks system of units 
and will express all angular quantities in 
radians . 

The Truth Model Subsystem will be designed and 
built to facilitate incorporation into the 
Goddard GRO Simulator (GGS) . 

On option, the Truth Model Subsystem will calcu- 
late the effect on angular movement caused by the 
scanning motion of the two tape recorders and the 
OSSE payload. 


5132 


4-2 



4.1.2 INPUT REQUIREMENTS 


R3.2.1 


R3.2.2 


For each time step, the Truth Model Subsystem 
will obtain the following profile data from the 
Profile Subsystem: 

• Earth's magnetic field 

• Unit vector from spacecraft to Sun 

• Vectors from spacecraft to Earth and Moon 

• HGAD pointing angles 

• Velocity vector 

• Total torque vector 

• Moment of inertia tensor 

• Star unit vectors 

The Truth Model Subsystem will receive the fol- 
lowing user input parameters from the SCIO Sub- 
system: 

• Initial attitude angles and rates 

• Sensor errors, biases, and misalignments 

• Sensor noise switch and noise specification 
(that is, mean and standard deviation) 

• Maneuver indicator 

• Thruster information (performance indicator, 
configuration, misalignment) 

• Magnetic torquer and reaction wheel informa- 
tion (performance indicator, configuration, 
misalignment) 

• Flags to include gravity-gradient torque and 
magnetic dipole moment 

• Integration stepsize (maximum) 

• Star tracker information 
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R3.2.3 


The Truth Model Subsystem will receive the fol- 
lowing control information from the SCIO Subsys- 
tem: current time. 

R3.2.4 The Truth Model Subsystem will accept the follow- 

ing commands from the OBC Model Subsystem: 

• To change the rate of rotation of the reac- 
tion wheels 

• To change pointing angles of HGAD and solar 
array 

• To charge or change the polarity of the mag- 
netic torque bars 

• To execute the thrusters (that is, to burn 
the thrusters); if thruster burn is com- 
manded, the command will specify which 
thrusters are to be turned on or off and the 
duration of the burn 

• To modify the current state attitude of the 
attitude hardware (turn off/on gyro, 
switches, etc.) 

R3 . 2 . 5 The Truth Model Subsystem will receive all input 

parameter uncertainties as standard deviations. 

4.1.3 OUTPUT REQUIREMENTS 

R3.3.1 The Truth Model Subsystem will output the follow- 

ing true data at every time step to the SCIO Sub- 
system for inclusion in the output data set: 

• True attitude (quaternions) 

• True body rates 

• True wheel speeds 

• True Sun unit vector 

• Spacecraft position and velocity 

• Sun sensor angles 
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R3 . 3 . 2 


The Truth Model Subsystem will output the follow- 
ing information to the OBC Model Subsystem at 
each time step: 

• Star tracker status 

• IRU status 

• Sun sensor status 

• IRU rates 

• Wheel speeds 

• Magnetometer measurements 

• HGA angles 

4.2 MATHEMATICAL SPECIFICATIONS 

4.2.1 DYNAMICS INTEGRATOR 

4.2.1. 1 Adams -Moulton-Bash f or th Integrator 

The equations of motion for the GRO spacecraft may be 
written in the compact form 

y ' = dt = fc) (4_1) 


The simulator within the Truth Model Subsystem employs an 
AMB integrator to solve the above system of differential 
equations at a discrete set of points in time, given a set 
of initial conditions. The method of solution developed 
here is sometimes referred to as a predictor-corrector. 

The fifth-order AMB predictor at the nth step uses the cur- 
rent value and four previous values of the function to pre- 
dict the state at the (n + 1) step, i.e.. 


,<P> _ 


n+1 


= y + h 


n 


1 ♦ 2 7 * 12 ^ * l ^ 



(4-2) 
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where h is the stepsize and V is a backward difference 
operator such that 


y A - £ < y <V< V 
7y A ” y A ' y A-i 

’ 2y A - y A - 2y A-i + y A-2 < 4 - 3 > 


7 y A - y A - 3y A-i + 


3y A-2 


- y A-3 


y A - y A - 4y A-i + 6y A-2 - 4y A-3 + y A-4 


(The vector notation has been dropped for convenience.) The 
derivative is then evaluated at step (n + 1) 

y A.l - f ( y n+l ' tn.l) < 4 ‘ 4 > 

and the AMB corrector uses the current difference and three 
previous differences to correct the function as follows: 


(c) 

n+ 


n 


_h_ 

720 


(469 + 109V + 49V + 19V' 


)y’ 

/J n 


251 

720 


y A+l 



(4-5) 


4. 2. 1.2 Derivation of AMB Equations 


The basic concept of the Adams integration is to integrate 
forward/ using the value of the function at the last inte- 
grated point and the value of the derivatives at that point 
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and previous points. The value Y n+ ^ is desired in terms of 

y and y', y' , , y'_ 9 , etc. The derivatives could be repre- 
n n n-i n ^ 

2 

sented by backward differences as y^, Vy^, V y^, etc. 

Before expressions are derived for the predictor or correc- 
tor equations , expressions for two operators, E and hD, are 
derived. By definition, 

Vy n + 1 * y n + l - y n 


so that 


n 


= <1 - V) y 


n+1 


or 


y , = (1 - V) 1 y_ (4-6) 

J n+1 n 

Equation (4-6) can be rewritten as an operator equation, 

y n+l == Ey n <4 ' 7a) 

where, by definition, E - (1 - V) . This relation shows 
that the operator E can be expressed in terms of backward 
differences as 

E = (1 - V) -1 = 1 + V + V 2 + — +V n + ... 

oo (4-7b) 

- Z vk 

k=0 
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The operator D is defined as equivalent to d/dt. Thus, 
y* (t) = Dy(t) . 

Expressing y(t) in terms of a Taylor's series using the no- 
tation of the operator D gives 


1.2 « , n 

y(t) = y(o) + tD y(0) + D z y(0) + ... £7 D n y(0) + ... 


00 


k=0 


(tD) 

k! 


y(o) 


(4-8a) 


or 


y(t) = | 1 + tD + ^7 D 2 + ... + D n + 


y(o) 


00 


- E 


k=0 


(tD) 


k! 


(4-8b) 


y(o) 


and, finally. 


y(t) = EXP(tP) y(0) (4-8c) 

where the usual definition of the exponential operator has 
been used. 

If y n = y(t). Equation (4-8b) may be used to obtain a con- 
venient expression for y 

y n+l = y(t + h > = EXP(hD) • y(t) = EXP(hD) • y n (4-9) 


5132 


4-8 



Combining Equations (4-6) and (4-9) gives 


hD 

e y 


n 


= (1 - V) 


-1 


n 


or, in operator form, 


e hD = (1 - V)' 1 (4-10) 

Hence, the operator hD can be written in terms of backward 
differences as 


hD = In [(1 - V) 1 ] 


(4-lla) 


or 


hD = -In (1 - V) 



+ 


2 ^ 


+ 


(4-llb) 



k=l 


The predictor and corrector formulas can be derived using 
the operators E and hD. From Equation (4—7), 

y r»l - E y n 

y n + l * E y n + y n - y n 

y n+l - y n WE - 1) y n 
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or 


y n+l = y n + 


(E - 1) 


hD 

hD y n 


and, finally. 


y n+l - y n + 


h tf - i) 

hD y n 


(4-12) 


Using Equations (4-7) and (4-llb), Equation (4-12) becomes 


n+1 ^n 


y- * h l V - * 7 2 * V 3 f * 7 " * |yi 
v ♦ £ + ... ♦ £ ♦ ... 1 

« J n 


(4-13) 


The division may be carried out to yield any desired number 
of terms. Thus, 


n+l * y n + h ( 1 + 2 7 + 12 ^ + f ^ + 720 V * + 288 


1.9Q87 6 5257 

60480 v + 17280 V 


7 * • • • ) y A 


(4-14) 


The predictor at the nth step. Equation (4-2), is obtained 
by truncating Equation (4-14) to six terms, i.e.. 


r n+l =y n + k(l + 2 y + 12 y ^ + 8 y3 + 720 y4 ) y n 


(4-15) 


The corrector equation is computed as follows: 


y n+l = y n+l ~ y n + y n = y n + Vy n+1 < 4 " 16a ) 
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or 


y n+l " y n + V ( h5 ) y n+l 


(“) 


(4- 


or 


n+ 


1 * y n + h (ho) Y n+1 


(4- 


Using Equation (4-llb) , it follows that 


n+1 


y + h 
J n 


V 2 V 3 
V + zr~ + o + 


n+1 


(4- 


Expanding Equation (4-16d) yields 


n+1 


y n + h I 1 " 2 V ” 12 


A T7 _ i— V 2 _ — 


24 


- 


12_ v 4 

720 


(4 


863 


—3— y ^ _ 

160 60480 


V 6 - 


275- y? 


24192 


y A+l 


To obtain Equation (4-5), Equation (4—17) is truncated to 
six terms, i .e. , 


n+1 


= y n + h ( X “ 2 V " 12 ?2 _ 2 


V 3 — — V 4 I y' (4- 

24 V 720 / y n+l ' 


After expanding the backward differences (Equation (4-3)) 
substituting these into Equation (4-18), and simplifying. 


16b) 


16c) 


16d) 


17) 


18) 
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the corrector at the nth step is given by the following re- 
lation : 


r (c > 

n+1 


= y n + 720 


469 + 109V + 49V + 19V' 


n 


+ 720 h y A + l 



4.2. 1.3 Changing Interval Size 


(4-19) 


To maintain accuracy between preset bounds, doubling and 
halving the interval size are often necessary. Because the 
integration is performed by using a difference table, a new 
difference table must be constructed in terms of the old 
difference table. Let the parameter p be defined by the 
ratio 


= new interval 
old interval 


(4-20) 


For example, if the interval is halved, p = 1/2; if it is 
doubled, p = 2. 

If V p y n e< 3 uals the first partial difference in terms of the 
new interval. 


VA * y n - y n-p * y A - E ' P 


y n = O - 


E P )y‘ 

/J n 


(4-21a) 


or 


V y' 
p J n 


= [1 - (1 - V) 1 


Iy A 


(4-21b) 
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and, finally. 


V y ’ = 
p-'n 


pv 


_ p(p - 1) v 2 + P(P - 1)(P - 21 v 3 


(4-21c) 


y 1 


The mth partial difference is readily obtained as 


V P 7 


• = |l - (1 - V) p j y' 


(4-22a) 


or 


v m y = 

P 


pv - p<p 2 ; u v 2 + p (p ~ *j (p =- zx v 3 

- • • •] y A 


(4-22b) 


The cases of doubling and halving are frequently encountered 
and may be represented, in abbreviated form, by a matrix 
multiplication (Equations (4-27) and (4-28)). 

4.2. 1.4 Partial Step Equation 

An equation for integrating a partial step forward using 
backward differences is developed here by using operator 
methods. Let p = (t n+p - t n )/h. Then, 


y „ + p “ E? y n - eP y n - y n + y n 

= y n + (E P - 1) y n (4-23) 

- y n + < E? " 1J M y n 
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where E and hD are previously defined. Thus, 


Yn (4-24) 

This is evaluated in terms of backward differences as fol- 
lows : 

(4-25a) 
or 





Equation (4-25b) is evaluated to the desired number of dif- 
ferences : 



Throughout any given simulation, the integration stepsize 
will change constantly. It will be decreased to satisfy 
certain accuracy requirements but increased to save computer 


5132 


4-14 



time spent for arithmetic calculations. There are some re 
strictions on how much and when the current stepsize can be 
changed . 

For GRO applications, there will be a maximum integration 
stepsize of 1000 milliseconds (1 second), the frequency at 
which the control torques are to be updated. During their 
application, the control torques will be constant and will 
significantly affect the dynamics of the spacecraft. Hence, 
to ensure an accurate simulation, the maximum stepsize will 
be used. 

The stepsize will be halved or doubled for two reasons. 
First, recomputation of the finite differences is simpli- 
fied. Second, halving or doubling the current stepsize only 
at certain times ensures that the integration will terminate 
at a time when the control torques are updated. Two step- 
sizes will be used: 

• H — For GRO, this is equal to the minor frame time. 
Assume that a minor frame begins at the time the 
control torques are applied. 

• h — This is the current stepsize. 

c 

— If there is a maximum stepsize, 

h < H and h = r: K = 0, 1, . . . , 30 

G - c 2 K 

— If there is no maximum stepsize, 

h = ^ where K = 0, ±1, ±2, ..., ±30 
c 2 k 

Thus, if a minor frame begins with a stepsize of H/2 , 
there are 2 K integration steps remaining in the minor 
frame . 
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There is also one other restriction. If there are 2 K steps 
K q i 

remaining, 2 must be less than or equal to 2 - 1, because 

31 

2 - 1 is the largest integer that can be stored in an 

1*4 variable. If 2 K > 2 31 - 1, stepsize halving is ter- 
minated, even if the accuracy requirements have not been 
met, and the simulation continues. 

In the case of halving and doubling stepsizes, let 


Vy* 



y’ 

y* 

y 


be the backward differences for the current stepsize, h . 

c 

Then, if h is to be halved, the new divided differences 
i. ^ 

V 1/2 y’ are given by 


7 l/2 

y 


1 

2 

1 

8 

1 

16 

128 


Vy 

• 

V 2 

1/2 

y' 


0 

1 

4 

1 

8 

5_ 

64 


V 2 

y' 

V 3 

1/2 

y' 


0 

0 

1 

8 

32 


V 3 

y ' 

V 4 

V l/2 

y* 


0 

0 

0 

1 

16 


V 4 

y‘ 


(4-27) 
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:o be doubled. 

the new 

differences 

V 

2 

y 


— j 


— 



-1 


— 

-i 

V 2 

y 


2 

-1 

0 

0 


Vy 

• 

V 2 

v 2 

y 


0 

4 

-4 

1 


V 2 

y 

V 3 

2 

y 


0 

0 

8 

-12 


V 3 

y' 

V 4 

2 

y 


0 

0 

0 

16 


V 4 

y 







— 


— 

— * 


(4-28) 


4. 2. 1.6 Equations of Motion 

The attitude state vector for dynamics simulation will be a 
11-component vector, X, consisting of the following compo- 
nents : 


X 1 = «l 


X 2 “ q 2 


X 3 “ q 3 


X 4 = q 4 


X 5 = L T. 


X 6 " L T. 


X 7 " L T, 


X 0 = L 
8 raw. 


X 9 " L mw, 


(4-29) 


X 10 " L mw, 
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where 


X 


11 



— t 

<3 = (<3^/ <32' ^ 3 ' ^ 4 ) is attitude quaternion 

representing the transformation from iner- 
tial to body coordinates 

= (L t , L_ , L_ ) is the total spacecraft angular 
1 l 2 i 3 

momentum in Joule-seconds in body coordinates 

L mw. = an 9 ular momentum of the momentum wheels in 
i Joule-seconds along the wheel axes 

The equations of motion define the time rate of change of 
the components of the state vector. The equations of motion 
are as follows: 


q = \ [12] q 


L T " N e + l T x “b 


L = N 
mw^ mw^ 


L = N 
mw^ iro^ 


L = N 
mw^ mw^ 


L = N 
mw. mw. 

4 4 


( 4 - 30 ) 

( 4 - 31 ) 

( 4 - 32 ) 

( 4 - 33 ) 

( 4 - 34 ) 

( 4 - 35 ) 
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where 




~ 0 

co^ 

3 

-co 2 

w l" 



[fl] 

= 

_C0 3 

0 

“l 

U 2 


(4-36) 



u 2 

-COi 

0 

3 





-CO! 

-co 2 

— C0_ 

3 

0 



(Wl, 

Wo , 

,0)3) = 

body 

angular 

velocity 

( radians 

per 

second) in 

body 

coordinates 




N* e = net external torque on the spacecraft newton- 
meters) (N • m) in body coordinates 

N = torque on the ith momentum wheel (N • m) applied 
mw i along the wheel axis 

The body angular velocity is computed as follows: 


“B - ['t ]- 1 • 


J B 


(4-37) 


where 


-1 


= inverse total spacecraft moment of inertial 

2 , 


tensor (kg • m ) in body coordinates 
~L = body angular momentum 

The body angular momentum is computed as follows: 


L 


B 



(4-38) 


where Ljnt = total angular momentum due to motion of paths 
internal to the spacecraft and 

L INT = L mw + L si + L TR + L HGA + L SA 

L + L + L + L 

mw^ mw2 mw^ mw^ 

angular momentum of scanning instrument, if used 
angular momentum of the tape recorders, if used 


and 


mw 


si 


TR 
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l HGA = angular momentum attributable to the motion of 
the high-gain antenna 

Lsa = angular momentum attributable to the motion of 
the solar arrays 

The use of effects of scanning instruments such as the OSSE 
and the tape recorders should be user selected as an option. 

The wheel speeds are then obtained from the following: 



i = 1, 2, 3, 4 


where 

4.2.2 



is the moment of inertia for each wheel. 


SIMULATOR INTERPOLATION 


From data available only at discrete times, a five-point 
Lagrangian interpolating polynomial is evaluated within the 
Truth Model Subsystem. As a simulation progresses in time, 
the five grid points for interpolation change to ensure that 
the request time lies between at least two of the grid 
points during a simulation. If the request time lies out- 
side the data available for the grid, an error flag is set, 
and simulation is terminated. 


The general form of an n-point Lagrangian interpolating 
polynomial is as follows: 


n 


p n <t> 


L^t) 


i = l 


(4-39) 
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where 


n 


L.(t) 


■TT 

j=i 

j*i 


(t - 

(4 - tj ) 


(4-40) 


and where the ordered pairs (t^, f^) i - 1» • • • • n (^^9 

ure 4-1) define data generated within the Profile Subsystem 
(Section 2) that will be interpolated, and f^ is a grid 
coordinate, such as the x-component of the Sun vector in GCI 
coordinates at time t. 

Equations (4-39) and (4-40) can be used to expand P n (t) 
with respect to t: 


P n < t > - it ®n * ^ (4 ' 41 

i=0 

where B = B (t., f.). The form of the interpolator in 
n n i i 

Equation (4-41) is used in the simulator because the time 
(2 min) between two consecutive grid points is very large 
compared with the maximum integration interval (1.0 sec). 

If the values of B r are computed for each 2-min interval 
and used in Equation (4-41), less time is expended compared 
with the use of Equations (4-39) and (4-40) over that same 

9 

interval. However, if the value of t is very large (10 , 
as in the simulator), an overflow will occur when using 
Equation (4—41) . To avoid this problem, the request times 
are scaled before the interpolating polynomial is evaluated. 
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f(t) 



Figure 4—1. General Form of an n— Point Lagrangian 
Interpolating Polynomial 


Suppose that data are requested at time t and that the cur- 
rent n = 5 grid points are ( t f^), with i = 1 to 5, and 
< t < t_. The five-point Lagrange interpolating polyno- 
mial Pj*(t s ) is given by 


p i<v - Z 


L i<v 


• f. 

i 


i=l 


(4-42) 


where t is the scaled request time 
s 


t 


s 



!•=. i 5 2 


(4-43) 


where t 3 is the middle value of the time coordinates t^ to 
t 5 / illusive; At is the grid point spacing presently defined 
such that At = tj + ^ - t . , with j = 1 to 4, and is computed 
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5l32G(4)-26 


by the software every time the grid points are updated 
(presently At = 2 minutes); and 





(4-44) 


The scaled grid points are given by 




- 2 , - 1 , 0 , 1 , 2 

j = 1/ •••/ 5 


(4-45a) 



(4-45b) 


The equivalence of Equations (4-39) and (4-42) is proven as 
follows; 



(4-46a) 


P §<V 




(4-46b) 



(4-46C) 
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(4-4 6d) 


5 

* Z L i (t > • £ i 

i = l 

The scaling, however, will ensure that |t | <2. The time, 

. S 9 

t, m Equation (4-39) is of the order of 10 . A loss of 
significant digits will occur if Equation (4-39) is evalu- 
ated as is. 

Expanding Equation (4-42) with respect to t and grouping 

s 

like terms yields 


P 5<V - Z A i fc s 


i = 0 


(4-47) 


where 


A 


0 


f 


3 


A 


1 


A 


2 


A 


3 


A 


4 


( £ i - 8f 2 + 8f 4 - 
12 

(-fj^ + 16f 2 - 30f ^ + 16f 4 - f,.) 
24 

(- f l + 2f 2 - 2f 4 + f,.) 

12 

f, - 4f _ + 6f _ - 4f. + f c 
_ 1 2 3 4 5 

24 


(4-48) 


The numerical coefficients in each expression for A^ are 
independent of At. 
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4.2.3 INTERNAL MOTION 

There are two instruments on the GRO spacecraft that affect 
angular movement and may therefore be included in a simula- 
tion at user option. These are the two tape recorders and 
the OSSE payload instrument. Both are modeled as scan type 
instruments . 

The angular momentum attributable to a scanning instrument 
along its scan axis is modeled as represented in Figure 4-2. 

The angular momentum attributable to a scanning instrument, 

L , along its scan axis, U gB , expressed in body coordinates 

S i i 

is given by 



where S 


+1 if X is odd 
-1 if X is even 


and X = MOD (t i - t on , t scan > + 1- 

l“ is the angular momentum for each of the tape recorders 
S i 

arid the OSSE and is TBD. 


U is the scan unit vector for each of the tape recorders 
s i 

and is TBD; U g for the OSSE is [0 1 0] T ; t Q is the time 
the instrument is turned on, t scan is l© n 9th of time of 
one complete scan, and t^ is the time for which the angular 
momentum is being calculated. 


4.2.4 SENSOR MODELS 

The attitude sensor models for IRU, FSS, CSS, FHST, wheel 
tachometer, and TAM are described in the following subsec- 
tions . 
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4. 2. 4.1 IRU Model 

The IRU consists of three rate-integrating gyros and has six 
channels that provide measurements of angular displacement 
along the three spacecraft body axes. One channel is pri- 
mary and one is backup for each axis. For each channel# 
gyro data generation involves the following two steps: 
calculation of angular displacement and modeling gyro noise 
to add on to the angular displacement. 

4. 2. 4. 1.1 Angular Displacement Calculation 
Calculate angular displacement as follows: 

1. Input angular velocity vector# oT. 

2. Project oT along the channel input axis, G, to get 
rate, r, measured by that channel (i.e., r = G • w) 
in radians per second. 

3. Compute angular displacement by integrating rate. 

a. If spacecraft is inertially fixed (low rate 
mode) # 

AG = (r + b) At 

where A0 = angular displacement in radians 

r = rate (computed in step 2) in 
radians per second 

b = component of rate bias along axis 
in radians per second 

At = gyro cycle time in seconds 

b. If maneuver is under way (high rate mode), the 
integrator described in Section 4.2.1 should 
be used to integrate (r + b) . Two successive 
values of 0 are then differenced to get A0, 
i.e., A0 = G(nAt) - 0((n - 1) At). 
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4. 2. 4. 1.2 Gyro Noise Modeling 

The gyro noise in GRO comes from two sources: 

1. Measurement noise (n v ) on angular rate. This is 

modeled as once-integrated white Gaussian noise and 

can be modeled as a sequence of random variables 

that are (a) Gaussian, (b) zero mean, and (c) vari- 
2 

ance of a v At. The value of such a random vari- 
able is added to A9 at each step, i.e., A9 
_____ v 

<* v ^At • Z, where Z is standard normal random 
variable. 

2. A random walk (n u ), which is Gaussian noise inte- 
grated twice before being added to A9. The model 
for computing A9 u is TBD. 

The noise from both sources are added to A9 to yield 

A0 NOISY = A0 u + A0 v + A0 

where A9 is from the angular displacement calculation and 
A0 NOISY the nois y angular displacement value. 

4. 2. 4. 2 FSS Modal 

The modeling of an FSS consists of the following steps: 

1. With the Sun in body coordinates, test to see if 
the spacecraft is in shadow. 

2. If the spacecraft is not in shadow, rotate the Sun 
vector to the sensor frame. 

3. If the spacecraft is not in shadow, compute Sun 
angles a, (3 (adding noise optionally). 
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4. If the spacecraft is not in shadow, test to see if 
the Sun is in the sensor field of view. 

These steps are described in the following subsections. 

4. 2. 4. 2.1 Spacecraft Shadow Testing 

The geometry used to determine if the spacecraft is in the 
shadow is shown in Figure 4-3. If the Sun vector lies in 
the shaded area between the two spacecraft-Earth tangent 
vectors, the spacecraft is in the Earth’s shadow. 

The angle 0 gE between the Sun unit vector, s, and Earth unit 
vector, e, is computed as 


s • e = cos 0 SE 


or 


©SE = cos -1 (s • e) 

The angle © c between £ and a vector from the spacecraft 
and tangent to the Earth is computed from 


cos 0 

c 



or 



where R is the distance from the spacecraft to the center of 
the Earth and R e is the Earth radius. 
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The Earth is blocking the Sun if 


0 SE - 9 c 


or 


cos 0 SE > cos e c 


or 



4. 2. 4. 2. 2 Rotating Sun Vector to Sensor Frame 

The Sun vector in sensor frame SS can be computed from the 
ephemeris Sun vector, S^, expressed in an inertial frame 
by the equation 

SS = [A] SB [A] 0I Sj 

where [A] OQ is the body-to-sensor frame rotation matrix 
SB 

and [A] dt is the GCI-to-BCS attitude matrix. 

B I 

4. 2. 4. 2. 3 Computing Sun Angles With Noise Optionally Added 

Figure 4-4 shows how the two Sun angles (a and 13) and the 
sensor frame are defined. (Nominally, the FSS reference 
frame is aligned with the BCS reference frame.) The +Z axis 
is the boresight vector. From this figure, tan a = SS1/SS3 
and tan (3 = SS2/SS3 , where SSI, SS2 , SS3 are the X, Y, Z 
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components of the Sun vector in the sensor frame. The noise 
is added to the angle; thus, with noise added 

a = tan -1 (SS1/SS3) + N a 
3 = tan -1 (SS2/SS3) + N R 

where N a , are Gaussian noise with means M a and and 
standard deviations D a and D^. M a , Mjj, D a , are user 
input via SCIO Subsystem. 

4. 2. 4. 2. 4 Testing if Sun in Sensor Field of View 

The Sun is in the sensor FOV if and only if |a| < A a and 
| (3 1 < A^, where A a and Ajj are maximum half-angles for the 
FOV for angles a and 3. If the FOV is square, A a and A R can 
be replaced by a single parameter A. 

4. 2. 4. 3 CSS Model 

The CSSs are located on the four outer corners of the solar 
arrays and are shown in Figure 4-5. These units provide an 
output current that is a measure of the angle between the 
normal to the unit surface and the Sun line. The data pro- 
vided are used to derive spacecraft roll and pitch attitude 
for Sun acquisition and/or reacquisition. For this mode of 
operation, the solar arrays are set to zero reference; that 
is, they are in the Y-Z plane, and the nominal orientation 
of outward unit normal vectors are as indicated in Fig- 
ure 4-5. 
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Figure 4—5. Coarse Sun Sensor Assembly 



The unit vectors to the CSS faces are given by the follow- 
ing, in body coordinates: 


-cos aAE + sin a sin B + sin a cos BAA 

C . = cos B - sin BAA 

Bi 

sin aAE + cos a sin B + cos a cos BAA 


where a is the angle between the body X— axis and the unit 
vector normal to the active solar array face, and B is -45, 
45, 135, and 225 degrees for sensors 1, 2, 3, and 4, respec- 
tively, and AA and AE are misalignments in the up/down and 
lateral directions when the sensor is viewed from outside 
the spacecraft. 

With the unit vector to the Sun 
the sensor measurement, O c ^, is 

-1 rn 

<*i = cos [R sb 


in body coordinates, Rg B , 
obtained as follows: 


/N 

C„_.] + n. 
SBi J i 


and 


where K is a scale factor nominally equal to 3.9 milli- 
amperes per degree and n^ is Gaussian noise, to be added 
on user option, and is given as 


n. = STD. + AM. 

i i i 


where is a random number between (-1, 1), and STD^ and 

AM. are the standard deviation and mean associated with 
i 

the ith sensor. 
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4. 2. 4. 4 FHST Model 


The FHST Model generates the star camera data. Output from 
a star camera consists of a (u, v) coordinate measured in 
the camera's focal plane (see Figures 4-6 and 4-7) and a 
star intensity. The camera is commanded by the OBC to 
"search" an RFOV. All stars contained in the star catalog 
are searched to determine if they are within the RFOV. (The 
catalog consists of the GCI coordinates of 12 selected stars 
for a period of time spanning the requested simulation.) 

Once a star is found within the RFOV, the corresponding (u, 
v) coordinates and intensity are digitized. If no stars are 
found in either camera FOV, no data is generated. 

If a star camera is turned on, data will be generated as 
follows. Subroutine STCENT checks for blockage of the 
camera by the Earth, Moon, or Sun. Let [C] be the matrix 
that rotates vectors from GCI coordinates to spacecraft 

A A A 

coordinates. Let S, E, M be the Sun, Earth, and Moon unit 
vectors in GCI coordinates. These are rotated into body 
coordinates as follows: 


E body 

E body 

M body 


[C] S 


[C] E 
[C] M 


The vectors in body coordinates are then rotated into camera 
coordinates via the transformation matrix [SC2ST] : 


/N 

s 

camera 


[SC2ST] S bQdy 
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earner a 


[ SC2ST] E body 


M - t SC2ST] M. d 

camera ooay 

Let c = cosine of Sun subtended angle, C E = cosine of Earth 

subtended angle, and C M = cosine of Moon subtended angle. 

No output from the star camera will be^generated if 

S (1) > C q or E er a ^ 1 ^ > C E ° r M camera^^ > C M' 

camera £ _ C = 1 . If the camera is not 

where ^ carrier a _ camera camera . , . .. rfov 

occulted, a search is initiated for stars within the 

Let STAR be a unit vector of a star in GCI coordinates. 

(£Sr is obtained by interpolating the discrete ephemeris 

information.) To obtain STAR in camera coordinates, the 

following transformations are performed in the following 

order : 


STR = 


STR. 


STR. 


STR, 


= [SC2ST] [C] STAR 


where matrices [ SC2ST ] and [C] are previously defined. 

Before the associated (u, v) coordinates are generated for a 
star, its intensity must be above a fixed threshold, and the 
unit vector defining it must lie within a circular cone with 
a vertex angle of measure 0 as shown in Figure 4-8. 

If STR passes these checks, the (u, v) coordinates are 
generated as follows. 

In terms of the angles v (see Figure 4-7) . 


STR = 


cos v cos 7k 

-sin v 

-cos v sin 7. 
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MOTES: 0 s 6 DEGREES. 

STRi MUST BE GREATER THAN COS 0 BEFORE STR IS GENERATED. 


Figure 4-8. Accept All Star Unit Vectors Contained 
Within the Cone of Angle 0 


9789 < 92*1 85 


From Figure 4-7, it can be seen that 


v = -tan X 


u 


tan v 
cos X 


Solving u, v in terms of the star observation vector yields 


v = -tan X 


cos v sin X 
cos v cos X 


STR 3 /STR 1 


_ tan .-g = — -Sin v — = STR /STR, 

cos X cos v cos X 21 

Gaussian noise can be added to the (u, v) coordinates. The 
angular coordinates of STR, CU, and CV, in the camera frame 
of reference, are computed as follows: 

CU = STR 2 /STR 1 + UNOISE 


CV = STR 3 /STR 1 + VNOISE 

where UNOISE, VNOISE are Gaussian noise to be added to the 
(u, v) coordinates. 

The next test determines if (CU, CV) lies within the RFOV 
defined by the following rectangle (see Figure 4-6): 

UPLUS = UZERO + DU 
UMINUS = UZERO - DU 
VPLUS = VZERO + DV 
VMINUS = VZERO - DV 
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(CU, CV) lies within the RFOV if CU < UPLUS and CU > UMINUS, 
and CV < VPLUS and CV > VMINUS. 

If any of the above conditions are violated, the next star 
in the star catalog is checked. This process continues 
until a star is found to satisfy all of the above conditions 
or the star catalog is exhausted. No data will be generated 
if there are no stars in either camera's RFOV. 

4. 2. 4. 5 Wheel Tachometer •Model 

Wheel tachometer readings are generated by computing the 
wheel speed from angular momentum and moment of inertia and 
computing the number of revolutions over a fixed time 
interval At. The model is as follows. 

For each wheel (i = 1, 2, 3, 4) 

1. Compute wheel speed 

S i = ^.^w. 

x 1 

where H w is the angular momentum of reaction 
i 

wheel i/ I w is the moment of inertia of reaction 
i 

wheel i, and is the speed in radians per 
second of reaction wheel i. 

The angular momentum, is measured along the re- 

i 

action wheel spin axis and is an element of the 
state vector. 

2. The number of counts accumulated over time At is 
computed as 


C i " S i 


K 


wh 


At 
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where C i is the number of counts over At, K wh is 
the conversion factor from radians per second to 
counts, and At is the cycle time in seconds. 

4. 2. 4. 6 TAM Model 

The TAM Model provides digital output from the magnetom- 
eters. The magnetometers measure the X, Y, Z components of 
the Earth’s magnetic field in the magnetometer reference 
frame corrupted by biases caused by spacecraft residual 
fields (assumed to be constant). The final output from the 
TAM Model reflects the effects of any constant bias fields 
and fields caused by the torquer coils. 

Let 1? be the magnetometer measurement in the sensor frame of 

reference (FOR), be the Earth's magnetic field (in 

m 3 y 

the sensor FOR), B, . be the constant magnetic field 

DlaS 

bias, and B . , be the magnetic field due to the elec- 
COl IS 

tromagnetic coils measured at the magnetometers. Then, 

^ - ®mag + ^bias + ^coils 

The Earth's magnetic field B is obtained as follows. 

Ilia y ^ 

The Earth's B-field in GCI coordinates, B GCI , is obtained 
from the profile data set. If the transformation matrix [C] 
rotates vectors from GCI to spacecraft coordinates, the 
B-field in spacecraft coordinates, BSC, is given by 


BSC = EC] B gci 

The B-field is then rotated into the magnetometer FOR using 
the matrix [SC2MAG] 


B = [SC2MAG] BSC 
mag 
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where B 

mag 

eter FOR. 


is the Earth's magnetic field in the magnetom- 


The term B ^ is the field generated by the torque coils 
measured at the magnetometers: 


B coils - [ETQCPL] in 


(4-49) 


where m is the vector of the torquer coil commands and 
[ETQCPL] is the torquer coil/magnetometer coupling matrix. 
The matrix [ETQCPL] is derived as follows. 

Consider the X-axis torquer coil. The magnetic field at the 
magnetometer attributable to the torquer coil is modeled as 
the sum of the two poles, which have a strength of +M and 
-M, respectively (see Figure 4-9): 


B x = M 


r - r 
m + 


r - r 

m : 


(4-50) 


m 


-m 3 rt a -r_\ 


where M is the magnetic pole strength of the torquer bar 
(pole-centimeters (cm)), r^ is the vector from the origin 
to the magnetometer, r* is the vector from the origin to 
the positive pole of the torquer coil (cm), and iT_ is the 
vector from the origin to the negative pole of the torquer 
coil (cm). Here, r^, "r + , and iT_ are measured in an arbi- 
trary reference frame. The magnetometers on board GRO are 
nominally aligned with the body coordinate system. 

By definition, a dipole is equal to the pole strength times 
the distance between the positive and negative poles. Since 
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the commands to the torquer coils are in terms of dipoles, 
the following relationship is defined for convenience: 

K • M = d • M 
cx 


where M is the dipole commanded to the X-axis coil (pole- 

OX 

cm), K is a unitless constant, d is the distance between the 
positive and negative poles (cm), and M is the strength of 
the poles (pole) . 

Therefore, Equation (4-50) can be written in terms of the 
commanded dipole, M : 



where d is the vector from the negative pole to the positive 
pole . 

Simplifying Equation (4-51) will yield Equation (4-52a) : 



‘xl 


Q 


x2 


'x3 


M 


cx 


(4-52a) 


3 

where Q x ^ (i = 1, 3) is in units of 1/length . 

Similar relationships can be written for the magnetic fields 
generated by the y and z torquer bars: 


B = 

y 


Q 


yi 

5 y3 


r-i 


cy 


( 4 - 5 . 
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B = 
z 


The fields attributable to the x, y, z torquer coils meas- 
ured at the magnetometer are given by B x , B y , and B z . The 
dipoles commanded to the x, y, and z torquer coils are given 
by M cx , M cy , and M cz , respectively. 

By the principle of superposition, B co ii s ' the total mag- 
netic field due to the x, y, and z torquer coils, is given by 


‘z 1 


l z2 


‘z3 




cz 


(4-52c) 


B • _ = B + B + B r 

coils x y J 


Equations (4-52a-c) can be written as a matrix product: 


B coils 

^xl ®yl ®zl 

^x2 ^y2 ®z2 


" M cx~ 

M cy 


_ ^x3 ®y3 ®z3 _ 


r 

3 

o 

N 

L. 


Therefore, from Equation (4-49), 



®xl 

Qyl 

Q zl 

[ETQCPL] = 

Q x2 

^y2 

Q Z 2 


Q x3 

Q y3 

Q z3 


and 


m = 


M 


cx 


M 


cy 


M 


cz 
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where [ETQCPL] is the torquer coil/magnetometer coupling 
matrix and m is the torquer coil commands (dipoles in 
pole-cm) . 

Ideally, the magnetometer frame is parallel to the space- 
craft frame. Any misalignment is assumed to be a rigid body 
rotation of the TAM, which will be represented internally by 
a direction cosine matrix and to the user as a Euler rota- 
tion sequence. The order of rotations is TBD, but should be 
chosen so that no singularities occur for O-deg rotations. 

4.2.5 ACTUATOR MODELS 

4.2.5. 1 Reaction Wheel Assembly 

Torques imparted by the reaction wheel assemblies (RWAs) are 
modeled as follows. The wheel torque is provided by an al- 
ternating current two-phase induction motor, which is driven 
by square pulses provided by a reaction wheel drive elec- 
tronics package. The torque level is controlled by varying 
the duty cycle or fraction of each half-cycle in which volt- 
age is nonzero. 

The torque equation is 

N wheel = X DC * N EM ~ “friction (4-53) 

where “wheel = ne ^ torque on wheel 

X DC = fraction of each half-cycle that the volt- 
age is nonzero (the duty cycle) 

n EM = electromagnetic torque when the duty cycle 
is unity 

“friction = torc J ue created by bearing friction 

The value N EM is proportional to wheel speed and the duty 
cycle X DC is proportional to a control voltage provided by 
the OBC. Both of these functions are generated by piecewise 
linear interpolation on a table of calibration parameters. 
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The duty cycle, X DC , is varied between +1 and -1 (inverted 
voltage polarity) by a control voltage, as shown in Fig- 
ure 4-10). The OBC first computes the control voltage, 
I CMD ( coun t s )* Then the duty cycle is obtained by 


y ' 

DC 


= X. 


<|I 


CMD 



*1 * X j-1 * IW £ T j < 


(4-54a) 


or 


X DC 


= if 11 


CMD ' ~ I M 


If 


I CMD < 0/ X DC X DC 


(4-54b) 


or if 


I CMD - °' X DC X DC 


where (I., X^, (I 2# X 2 ), ..., (I M , Xj^) are calibration 
parameters . 

N £M is obtained by 


n em - a i + < s c - s i> • 


a. , - a. 
i-I i 

s . , - s . 
i-l 


|, s x < s i _ 1 < s c 


(4-55a) 


< s i < s n 
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re 4-10. Duty Cycle as a Function of the Commanded 
Input Voltage (Example From Landsat-D) 




(4-55b) 


N EM " a 8 lf S c - S n 


n em " a i if S c £ S 1 


(4-55c) 


The (s 1 , c^), (s 2 , a 2 ), . .., (s n , a n ) are calibration pa- 

rameters (see Figure 4-11). 

n is modeled as the sum of a Coulomb term and a 

friction 

viscous term 


. . . = N , • sign (s_) + fv (4-56) 

friction coul c' 

where N , is the Coulomb friction coefficient, fv is the 
coul 

viscous friction coefficient, and sign (s c ) gives the di- 
rection of the wheel momentum. 

4. 2. 5. 2 Magnetic Toraue r Assembly 

When current is applied to a ferromagnetic core electro- 
magnet (also called a magnetic torquer assembly (MTA) ) , the 
resulting relationship between magnetic intensity (related 
to current) and magnetic induction (related to dipole 
strength) is multivalued. There are two possible dipoles 
that can be generated for a given current (provided that the 
magnet is driven to saturation at all times). Therefore, the 
resultant dipole depends on the applied current and whether 
the current is increasing or decreasing. 

The hysteresis loop describing the MMS torquer coils is 
modeled by a parallelogram as shown in Figure 4-12. The 
demagnetization of the coil is not modeled. 

When wheel momentum unloading is required, the OBC will com- 
mand a dipole so that excess angular momentum will be dissi- 
pated. Eventually, the commanded dipole will exceed the 
absolute value of the constant residual dipole, D r , in 
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Figure 4-12. For any time thereafter, a dipole moment re- 
sulting from an OBC command can be represented by a point on the 
parallelogram in Figure 4-12. 

The resultant magnetic dipole corresponding to an OBC com- 
mand is computed for each of the three coils onboard, as 
follows . 

Consider one coil. First the OBC commanded dipole (I 

. . 7 CMD 

in counts) is converted to ampere-meters by the. following 

equation: 


°CMD ” S ^ I CMD (4-57) 

where D CMD is the commanded dipole in ampere-meters 2 , S is a 
scaling factor, and Z is the command value for a zero- 
commanded dipole. 

The dipole caused by this coil will change only if the dif- 
ference between the dipole at the last sampling, D, 

, , , last' 

and the current commanded dipole, D CMD , is greater than 

the residual dipole moment, D r . 

Therefore, the current dipole, D^,, taking into account the 
current command, is determined as follows: 


D c 

D CMD ~ D r 

D CMD - D last 

> D r 

(4-58a) 

D c 

= °CMD + D r 

lf °CMD " D last 

< -D 

r 

(4-58b) 

D c 

= D last if 

l°CMD " D last 1 - 

D r 

(4-58c) 


If the applied current exceeds a certain value, the magni- 
tude of the dipole produced by the ferromagnetic coil 
reaches a maximum. This is modeled in the MMS simulator as 
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shown in Figure 4-12, i.e., |D C | < DP SAT ' where D p SAT is 
the saturation value for the coils. 

Once the dipole moment, DP*, is determined, the torque pro- 
duced by its interaction with the Earth's magnetic field can 
be computed. The net torque, ^ 8/c » applied to the space- 
craft is 




* B 


(4-59) 


where If is the Earth's magnetic field in Tesla <1 tesla - 
10 4 gauss) in the spacecraft coordinate system, and 
DjT j is the vector sum of dipoles resulting from the OBC 
commands in ampere-meters^ (in spacecraft coordinates). 

The vector of current dipoles, DP acs ' *- s obtained by using 
Equation (4-58). To obtain DP s/c , the following trans- 
formation is applied: 


DP s/c ^ T coils^ DP acs 


(4-60) 


where TT 1 is the matrix whose columns contain the 

L C Q 1 Is 

unit vectors of each coil axis in the BCS frame. 

The Earth’s magnetic field in GCI coordinates, B^j, a t 
the current time is available by interpolating the ephemeris 
information (see subroutine INTERP in Reference 10). Let 
[C] be the matrix that rotates a vector from GCI to space- 
craft coordinates. Then, 



t C1 b gci 


(4-61) 


Attitude information in terms of the quaternion at the cur- 
rent time is available from ADMPAR. The attitude matrix [C] 
is constructed from the quaternion via subroutine EULERC. 
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The torque on the spacecraft in the spacecraft frame due to 
the commanded dipole is then given by 


T , = DP , * B , 

s/c s/c s/c 


(4-62) 


4. 2. 5. 3 Attitude Control Thrusters 

The ACTS generate a nominal thrust level of 22.241 newtons 
(5 lbf ) . There is a redundant set of thrusters located on 
legs at the four corners of a rectangular structural frame, 
as shown in Figure 4-13. They are numbered from 1 to 8, 
with the primary set given as 1 to 4. The thruster model 
employed is a trapezoidal model. The full thrust level is 
22.241 newtons at steady state with a thrust buildup from 
t g/ the start time, to t^, the time steady thrust is 
reached. The thrust tail-off is from t 2 , the time the 
motor is commanded off, to t f , the final time or the time 
the thrust reaches zero. It is assumed that the control 
system will command the proper motors to fire and when to 
fire them, thus defining t and t~. The intervals t 

S A S 

to t 1 and t 2 to t f are functions of the motor and need 
to be defined. Representative values may be used if they 
are not defined by the prime contractor. The setting of 
these time intervals should be controlled by the user. The 
system user may choose to set these time intervals equal to 
zero, simulating instantaneous on and off operation of the 
thrusters. Determination of the thrust depends on which of 
the three regions the time of evaluation is in: 

F m = F i [<t " t s )/(t l ~ fc s )] when fc s - < fc l 
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F m - F i when 

F^ = t(t f - t)/(t f - t 2 )] when t 2 < t < t f 

where is the motor thrust level and is the motor thrust 
along the motor axis. 

The motor thrust is then scaled as follows: 

F m = S i F M 

where S i is the scale factor for the ith motor. The scale 
factor allows the simulation of different performance levels 
of a motor, such as hot, under performance, or failure mode. 

The thrust vector for each motor in body coordinates is 
given by 



cos 0 sin 4> - sin 9Aa + cos 0 cos <J>AE 
sin 0 sin 4> + cos 0AA + sin 0 cos 4>AE 
cos 4> - sin <|>AE 


M 


where © in the column matrix is really 0.^ and, if nonzero, 
will be given from the following: 

OJ 


A nonzero value of 0 is TBD. The cant angle, 4>, is cur- 
rently equal to 29 deg. The misalignments for each 
thruster, AA and AE, are expressed in radians and should be 
available to the system user as input. They represent mis- 
alignments in lateral and up/down directions, respectively, 
i.e., in directions orthogonal to the motor axis. 


i 

1/5 

2/6 

3/7 

4/8 

9 i 

6 

180-8 

180 + 9 

-9 
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With the thrusts determined for each firing motor, the re 
suiting torgue is obtained from the following. 

lT T = R* x Fb 


where 1* is the vector from the spacecraft center of mass and 
is given in Table 4-1. The torque for each motor fired is 
added vectoxially to obtain the total torque due to thrust- 
ing . 


4. 2. 5. 4 Orbit Adj ust Thrusters 


The OATs generate a nominal thrust level of 444.822 newtons 
(100 lbf ) . They are located on the underside of the space- 
craft symmetrically about the -Zg axis between the fuel 
tanks. Their locations are shown in Figure 4-13, where they 
are identified as thrusters A, B, C, and D. The modeling of 
the thrust for each motor is the same as that of the ACTS as 
given in Section 4. 2. 5. 3. But once the motor thrust, 
is obtained, the thrust vector for each motor in body coor- 
dinates is given by 


F 


B 


i 


-sin aAA + cos aAE 
cos aAA + cos aAE 
1 


M 


where a is 0, 180, 90, 270 for motors A, B, C, and D, re- 
spectively, and AA and AE are motor misalignments as men- 
tioned in Section 4. 2. 5. 3. The torque for each motor fired 
is obtained, and the total torque generated is obtained as 
mentioned therein. 
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Table 4-1. Thruster Locations 


MOTOR 


LOCATION (m> 


ORBIT 

A 

C 

B 

0 

ATTITUDE 

5 

6 

7 

8 
1 
2 

3 

4 


0.381 

0 

-0.381 

0 

1.659 

>1.659 

-1.659 

1.659 

1.659 

-1.659 

•1.669 

1.659 


0 

0.381 

0 

-0.381 

1.463 

1.463 

-1.463 

-1.463 

1.546 

1.546 

-1.546 

-1.546 


-0.475 

-0.475 

-0.475 

-0.475 

-0.475 

-0.475 

-0.475 

-0.475 

-0.475 

-0.475 

-0.475 

-0.475 


NOTE: ATTITUOE THRUSTERS ARE IN SETS, 1, 2, 3 AND 4 
ANO 5, 6, 7, AND 8. ONE SET IS PRIMARY AND THE 
OTHER IS SECONDARY. UNTIL OTHERWISE INFORMED 
ASSUME SET 1, 2, 3. AND 4 IS PRIMARY. SUBSCRIPT 
8 OENOTES THE BODY COORDINATE SYSTEM. 
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SECTION 5 - ONBOARD COMPUTER MODEL SUBSYSTEM 


The OBC Model Subsystem simulates functions normally per- 
formed on board the spacecraft. The functions include re- 
sponding to ground commands/ processing sensor data, and 
generating commands to the actuators. 

5.1 REQUIREMENTS 

5.1.1 PROCESSING REQUIREMENTS 

R4.1.1 Simulate the GRO attitude determination algo- 

rithms and the control laws of the OBC (NSSC-1) . 

R4.1.2 Respond to ground commands issued by the Simula- 

tion Control and Input/Output (SCIO) Subsystem. 

R4.1.3 Process the following sensor data: 

• IRU 

• FSS 

• CSS 

• FHST 

• Wheel Tachometer 

• TAM 

R4.1.4 Simulate the backup control laws of the attitude 

control electronics. 

R4.1.5 Generate commands to the following actuators: 

• RWA 

• MTA 

• Thrusters 

R4.1.6 Simulate the following modes of operation (see 

Section 1.2.2 for descriptions): 

• Normal pointing mode 

• Normal maneuver mode 

• Sun-referenced pointing mode 

• Safehold mode 
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R4.1 

R4.1 

R4.1 

5.1. 

R4.2 

R4.2 

R4.2, 


5.1.3 
R4.3. 
R4 . 3 . 

R4 . 3 . : 


• Thruster maneuver mode 

• Velocity control mode 

• Thruster command mode 

• Backup orbit maintenance mode 

Determine commands required for pointing high- 
gain antenna at TORS. 

Determine solar array position. 

Interpolate GRO and TDRS ephemerides. 

2 INPUT REQUIREMENTS 

.1 Accept the ground commands (listed in Appendix D) 
from the SCIO Subsystem. 

Receive user-specified input parameters from the 
SCIO Subsystem. 


.7 

.8 

.9 


.2 


.3 


1 

2 


Accept the following types of sensor data from 
the Truth Model Subsystem: 

IRU 
FSS 
CSS 
FHST 

Wheel tachometer 
TAM 

OUTPUT REQUIREMENTS 

Output actuator commands to the Truth Model. 

Output error codes, precision checks, and analy- 
sis data to the SCIO Subsystem. 

Send the following telemetry to the SCIO Subsys- 
tem: 

• OBC Subsystem attitude error (radians) 

• OBC Subsystem compensated rates (radians per 
second) 
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• Break track commands 

• Commands to enable/disable OATs 

• Commands for positive and negative rotation 
about each axis (ACTs) 

• Commanded magnetic dipole moment components 

• Wheel torque commands 

• HGA azimuth and elevation slew commands 
( radians) 

• Attitude control and determination mode flag 
5.2 MATHEMATICAL SPECIFICATIONS 

5.2.1 SENSOR PROCESSING 

5.2. 1.1 Inertial Reference Unit Data Processing 

The IRU data processing function is divided into two sub- 
functions: gyro data acquisition and gyro data compensa- 

tion. 

The functions of gyro data acquisition are 

• Gyro counter overflow detection and correction 

• Gyro prefilter 

Figure 5-1 is a functional block diagram of gyro data acqui- 
sition. The gyro prefilter consists of two first-order 
filters in series. The bandwidth is set to 0.1 Hz, which is 
lower than the first bending mode bandwidth (0.36 Hz) and 
higher than the control system bandwidth (0.013 Hz). 

The function of gyro data compensation is to compensate gyro 
data for scale factors and alignment and bias errors. Fig- 
ure 5-2 is a functional block diagram of the gyro data 
compensation algorithm. 

5. 2. 1.1.1 Gyro Data Acquisition Function 

The gyro data acquisition function (GYROD) uses the gyro 
data counts to perform overflow compensation and prefilter- 
ing, as shown in the following pages. 
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There are six gyro channels. Three are labeled primary, and 
the other three are backup channels. Table 5-1 gives the 
gyro channel definitions. The gyro channel data (NG.. ; i=l 
to 3 and j=l to 2) are sampled at 64 msec in all modes. 


Table 5—1. Gyro Channel Definitions 


Axis (i) 


Channel (jj Gvro (k) 


Roll (X) 1 

1 

Pitch (Y) 2 

2 

Yaw (Z) 3 

3 


A 

B 

A 

B 

A 

B 


1 

2 

1 

2 

1 

2 


1 

3 

2 

3 

1 

2 


Input — GYROD uses the following input: 


Name 


Description 


FLTRON 


GPA 

GPB 

GPBS 

GYRINIT 

IGYi 


PNGFi 


Gyro prefilter data base flag (data base constant 
( DBC) ) : 

= False, disable prefilter 
= True, enable prefilter 

Gyro processing prefilter coefficient (related to 
GPB1) (DBC) 

Gyro processing prefilter coefficient, which de- 
termines prefilter bandwidth (DBC) 

Gyro processing prefilter coefficient (GPB1) (DBC) 

GYRODAT initialization flag (from MODECON) 

Gyro channel selection flag where i = X, Y, Z 
body axes gyros (DBCs): 

= 0, channel A 
= 1, channel B 

= — 1 / gyro data are bad for axis i 

Past value of filtered gyro data for i = X, Y, z 
gyro sensor axes (variables from gyro data com- 
pensation function (GYROCOMP) /GYROD) 
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Name 


Description 


NGij Raw gyro data pulse counts where i = X, Y, z gyro 

sensor axes; j = 1, 2 for channel A or B (output 
of IRU pulse counters) 

NGLC Gyro accumulator overflow test limit (DBC) 

NGS Gyro accumulator saturation level (DBC) 

• Processing — The gyro data acquisition execution in- 

terval is 256 msec, and execution is performed before gyro 
data compensation. 

For a given 256-msec time interval, four separate sets of 
gyro information have been gathered. At any one time, five 
complete sets of gyro data are saved. Four of these are for 
the current 256-msec cycle, and the last set is from the end 
of the previous 256-msec cycle. In this section, the pre- 
vious 256-msec cycle set of gyro channel A and B data is 
subtracted from the current set of gyro channel A and B data 
for the current 256-msec cycle. 


If the GYRODAT initialization flag is set (GYRINIT=1) , the 
following is performed: 


For i = 1 to 3 and j 

PNG. . = NG. . 

ID ID 

TNG i j = 0 
NGI i = 0 
NGL i = 0 
PNGF i = 0 
GYRINIT = 0 


= 1 to 2 

| Past value of gyro pulse counters 
| Cumulative gyro counter 
| Prefilter state variable 
| Prefilter state variable 
I Past filtered counter 


The data are first converted from radians (from the Truth 
Model) to counts: 


NG i j = NG i j/GSFH i j (for gyro high rate) 
NG^j = NG^j/GSFL^j (for gyro low rate) 
For i = 1 to 3 and j = 1 to 2 
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Once the data conversion is completed, the following compu- 
tations are performed for both primary and backup channels 
(i=l to 3, j=l to 2) : 


DNG = NG. . - PNG. . 

x 3 l] 


PNG. . = NG. . 
13 13 


where DNG = difference in gyro counts during last 64 msec 

PNGij = Past values for gyro counts from last 64 msec 
or last frame (i = X, Y, Z and j = 1, 2 for 
channels A and B) 

If |DNG| > NGLC, the gyro pulse counter for i = X, Y, or 

Z has overflowed, and the gyro data require compensation, as 
follows : 


DNG = DNG - sign (DNG) * NGS 
The differences are then added up follows! 

TNG i j = TNG... + DNG for i=l to 3 and j=l to 2 

where TNG^ = cumulative gyro counter (OBC gyro counter) 

The prefilter step is performed next. The filter step com- 
putations are not performed for a particular axis if the 
proper flag is set (IGY. = -1) . if the prefilter flag 
(FLTRON) is set to TRUE, the filter state variables are 
updated to minimize the filter transient if the prefiltering 
is ever performed. If the prefilter flag is set to FALSE, 
the following computations are performed: 

j = IGY i + 1 

NGT1 . = TNG.. + GPA * NGI . 

Ill 1 
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NGT2 i = NGTl^ + NGI^ + GPA * NGL^ 

NGI i = NGTl i 

NGF i = GPBS * (NGT2J + NGL i ) 

NGL^ = NGT2 i 

(where j indicates the prime gyro channel (j=l to 2)) 

If the filter is off, the following computations are per- 
formed : 


j = IGYj^ + 1 
NGF i = TNG^ 

NG^ « TNG i V(2 * GPB) 

NGL i = TNG i j/(2 * GPBS) 

(j indicates the prime gyro channel (j=l or 2)) 

where NGT1 • = temporary variable 
NGT2. = temporary variable 
NGI . = filter state variable 
NGL^ = filter state variable 
NGF^ = filtered gyro data 

• Output — GYROD produces the following output: 

Name Description 


NGFi 

Filtered values of gyro data for 
sensor axes (to GYROCOMP) 

i = 

X, Y, Z 

gyro 

NGHi 

Past value of filtered gyro data 
gyro sensor axes (to GYROCOMP) 

for 

i = X, Y 

, z 

TNG i: j 

Cumulative OBC gyro counters for 
nels (i = 1 to 3 and j = 1 to 2) 
SAFECON) 

all 

(to 

six gyro 
GYRODAT, 

chan 
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5.2. 1.1.2 Gyro Data Compensation Function 

The gyro data compensation function (GYROCOMP) uses gyro 
count increments to produce compensated body roll, pitch, 
and yaw angular rates, as shown in the following tabula- 
tion. It performs compensation for scale factors, alignment 

errors ' an( 3 gyro bias compensation terms as part of this 
process. 

— GYROCOMP uses the following input: 
Description 

ACS sample period (depends on mode) (from MODECON) 

Elements of gyro alignment calibration matrix 
from gyro sensor axes (j = 1, 2, 3) to ACAD body 
axes (x = 1, 2, 3) (DBCs) 

Gyro high-rate mode scale factor for i ■ X, Y Z 
gyro sensor axes (DBCs) 

Gyro low-rate mode scale factor for i = X, Y, Z 
gyro sensor axes (DBCs) 

Gyro channel selection flag where i = X, Y, Z 
gyro sensor axes (DBCs): 

= 0, channel A 
= 1, channel B 
= -1, bad gyro axis data 

Filtered gyro data for i = X, Y, Z gyro sensor 
axes (variables from GYROD) 

Past values of filtered gyro data for i = X, Y, Z 
gyro sensor axes (variables from GYROD/GYROCOMP) 

Gyro rate status word (high = 0 or low = 1 modes); 
(i - X, Y, Z gyro axes) (status word from IRU) 

Estimated bias gyro rate where i = X, Y, z ACAD 
body axes (from ESTIMAT via KININT or DBC/GND) 

P rocessing — GYROCOMP is executed every 512 msec in 
the normal pointing and normal maneuver modes and every 
256 msec in the velocity control and the thruster maneuver 

modes. This module is performed before kinematic integra- 
tion. 


Name 

ACS I NT 
GCij 

GSFHi 

GSFLi 

IGYi 

NGFi 

PNGFi 

SENSTAi 

THETBi 
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The processing first computes the change in gyro counts over 
the past processing cycle and saves the last computed 
filtered gyro counts for all three active gyro channels. 

This computation is performed only for those gyro axes that 
have been labeled good (IGY^ ^ -1): 

CNF^ = NGF i - PNGF i 

PNGF i = NGF t 

where i is X, Y, Z (gyro sensor axes) and CNF^ is the dif- 
ference in filtered gyro counts over the past processing 
cycle . 

The processing then determines the rate mode for each gyro 
channel and converts gyro counts to radians. The rate (high 
or low) of the gyro channel currently in use is determined 
from the gyro rate status word SENSTA^. If SENSTA^ = 0, the 
gyro is in the high-rate mode, and if the gyro channel is 
good ( IGY^ ^ -1), the following computations are performed: 

j = IGY i + 1 

THETC i = GSFH i j * CNF i 

If SENSTA i = 1, the gyro is in the low-rate mode, and if the 
gyro channel is good ( IGY i * -1), the following computations 
are performed: 

j = IGY i + 1 

THETC^ - GSFL i j * CNF^ 

where i is X, Y, Z; THETC^ is the gyro angular increment in 
radians; and j is the prime channel indicator (j = 1 or 2). 
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Normally all three gyro channels will have the same rate 
mode; however, the processing allows for mixed-mode opera- 
tion. The converted gyro angular increment data are next 

transformed from gyro sensor axis coordinates to ACAD coor- 
dinates : 

WG X = (GC 11 * THETC x ) + (GC 12 * THETCy) + (GC 13 * THETC^ ) 

WG Y = < GC 21 * THETC x ) + (GC 22 * THETCy) + (GC 23 * THETC Z ) 

WC 2 = (GC 31 * THETC X ) + (GC 32 * THETCy) + (GC 33 * THETC Z ) 

The increments are then corrected for estimated gyro rate 

bias: 


THETA ^ = WG a - THETB^ * ACSINT 


where WG^ 
THETA 


l ~ 


uncompensated gyro angular increments in roll 
Pitch, and yaw (i = x, Y, Z ACAD body axes) 

compensated gyro angular increments in roll 
Pitch, and yaw (i = x, Y, Z ACAD body axes) 


The compensated angular rate components of the spacecraft 
are then computed as 


W. = THETA i /ACSINT 


where Vi i represents compensated spacecraft body angular 
rates m roll, pitch, and yaw (i = X, Y, z body axes). 


Name 

PNGFi 


Ou tput — GYROCOMP produces the following output: 


— Description 

Past values of filtered gyro data for i 
ACAD body axes (to GYROD) 


= X, Y, z 
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Name 


Description 


THETA-; Compensated angular increments in roll, pitch, and 

yaw where i = X, Y, Z ACAD body axes (to KINIT) 

yj. Compensated spacecraft body rates in roll, pitch, 

and yaw where i = X, Y, Z ACAD body axes (to 
WHECON, ATTEST, HLTCON , LLTCON , and SAFECON) 


5.2. 1.2 Fine Sun Sensor Data Processing 

The FSS data processing function (FSSPROC) converts and com- 
pensates raw data from the selected FSS head to form tangents 
of the angular components of the Sun vector in FSS head coor- 
dinates (Figure 5-3). 


Input — FSSPROC uses the following input: 


Name 

AF i j k 

FSSA 

FSSB 

HN 

SUNPRS 


Description 

FSS data calibration coefficients where i = 1,2, 
j = 1,2, 9, k=l , 2 (DBCs ) 

Raw FSS alpha angle in radians (from Truth Model) 
Raw FSS beta angle in radians (from Truth Model) 
FSS head number; HN=0: Head 1; HN=1: Head 2 

Sun presence flag 


• Processing — FSS data processing is scheduled every 

32.768 seconds in all modes. FSS data processing first 
looks at SUNPRS to determine the Sun presence. If SUNPRS is 
FALSE, no further processing of the raw data is performed. 
The remainder of the processing occurs if SUNPRS is set to 


TRUE. 


The next step is to take the raw FSS alpha and beta angles 
from the Truth Model and convert them to counts. This is 
performed as follows: 


C_FSSA = (FSSA-B_CONV)/A_CONV 


C_FSSB= ( FSSB-B_CONV) /A_CONV 
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The tangents of the alpha and beta angles in FSS head coor- 
dinates are computed using the input values of alpha and 
beta compensated for known calibration errors as follows: 

k = HN + 1 

X = AF llk + AF 12 k * C_FSSA + AF 13k * SIN(AF 14k * C_FSSA 
+ AF 15k > + AF 16k * SIN < AF 17k * C - FSSA + AF 18k> 

Y = AF 21k * AF 22k ’ C - FSSB + AF 23k * SIN(AF 24k * C - FSSB 
+ A F 25k ) + AF 26R * SIN(AF 27k * C_FSSB ♦ AF 28k > 

TA = <AF 19k ♦ X)/(1.0 - AF 19k * X) 

TB = (AF 2gk + Y) / ( 1 . 0 - AF 2gk * Y) 

• Output — FSSPROC produces the following output: 

Name D escriptiQn 

HN Sun sensor select status (to ATTEST) 

SUNPRS Sun presence flag (to ATTEST, MODECON) 

TA Tangent of the alpha Sun angle in FSS head coordi- 

nates (to ATTEST) 

TB Tangent of the beta Sun angle in FSS head coordi- 

nates (to ATTEST) 

5.2. 1.3 Fixed-Head Star Tracker Data Processing 
The FHST data processing function converts the raw FHST data 
to a form suitable for further processing and compensates the 
FHST measurements for the effects of known sensor measurement 
errors. It compensates for measurement error sources of geo- 
metric distortion, magnetic fields, temperature variations, 
and star intensity variations and converts the compensated 
angular data to FHST position coordinates. This function is 
performed every 32.768 seconds in the standby and normal 
pointing modes. 
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Input — FHST processing uses the following input: 

Description 

Flat field and temperature calibration coefficients 
for H where i = 1 to 19 (coefficient number) and 
j = 1/ 2 for FHST 1 or 2 (DBCs) 

Saved components of Earth's magnetic field vector 
along spacecraft axes where i = X, Y, Z (variables 
from magnetometer processing) 

Flat field and temperature calibration coefficients 
for V where i = 1 to 19 (coefficient number) and 
j = 1, 2 for FHST 1 or 2 (DBCs) 

Star intensity correction coefficients for H where 
i = 1 to 19 (coefficient number) and j = 1, 2 for 
FHST 1 or 2 (DBCs) 

Star intensity correction coefficients for V where 
i = 1 to 19 (coefficient number) and j = 1, 2 for 
FHST 1 or 2 (DBCs) 

Coefficients used to compensate H for effects of 
ZT axis magnetic field where i = 1 to 19 (coeffi- 
cient number) and j = 1, 2 for FHST 1 or 2 (DBCs) 

Coefficients used to compensate H for effects of 
XT axis magnetic field where i = 1 to 19 (coeffi- 
cient number) and j = 1 # 2 for FHST 1 or 2 (DBCs) 

Coefficients used to compensate H for effects of 
YT axis magnetic field where i = 1 to 19 (coeffi- 
cient number) and j = 1, 2 for FHST 1 or 2 (DBCs) 

Coefficients used to compensate V for effects of 
ZT axis magnetic field where i = 1 to 19 (coeffi- 
cient number) and j = 1, 2 for FHST 1 or 2 (DBCs) 

FHST selection flag, set during attitude estimation 
process (from ATTEST) : 

= 1, selects FHST 1 
= 2, selects FHST 2 


FHij Coefficients used to compensate V for effects of 
XT axis magnetic field where i = 1 to 19 (coeffi- 
cient number) and j = 1, 2 for FHST 1 or 2 (DBCs) 

FVij Coefficients used to compensate V for effects of 
YT axis magnetic field where i = 1 to 19 (coeffi- 
cient number) and j = 1, 2 for FHST 1 or 2 (DBCs) 

FHHAS i Saved raw FHST horizontal measurements where i = 1 

2 for FHST 1 or 2 (from ATTEST) 
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Name 


Description 


KF iik Coefficients that relate magnetic torquer bar coil 
currents to magnetic field at FHST where i = X, Y, 

Z (FHST axes), j = X, Y, Z (antenna boom axes), and 
k = 1, 2 for FHST 1 or 2 (DBCs) 

KST FHST measurement unit conversion (DBC) 

MDSi Saved components of torquer bar generated dipole 

moment in antenna boom coordinates (from ATTEST) 

FHTSi Saved FHST temperature data from FHST i where 
i = 1, 2 (from ATTEST) 

FHMSi Saved FHST intensities from FHST i where i = 1, 2 
(from ATTEST) 

XTi-j Components of FHST X-axis unit vectors along j ORC 

axis for FHST i where i = 1, 2 and j = X, Y, Z 
(DBCs) 

FHVASi Saved raw FHST vertical measurements where i = 1, 2 
for FHST 1 or 2 (from ATTEST) 

YTi-; Components of FHST Y-axis unit vector along j ORC 

axis for FHST i where i = 1, 2, j = X, Y, Z (DBCs) 

ZTji Components of FHST Z-axis unit vector along j ORC 

axis for FHST i where i = 1, 2, j = X, Y, Z (DBCs) 

• Processing — First it must be determined whether the 

processing is for FHST 1 or FHST 2. Let m denote the FHST 

chosen, and let 


H = FHHAS m 
m 

V = FHVAS 

m 

TS = FHTS 

m 

IS = FHMS 

m 

XT! = XT . for i = X, Y, Z 
i mi 

YT! = YT . for i = X, Y, Z 
i mi 
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for i = X, Y, Z 


zt: = zt . 

i mi 


kf: . = kf. . 

1J ljm 


for i = X, Y, Z and j = X, Y, Z 


where TS 
IS 


temperature measurement from selected FHST 
intensity measurement from selected FHST 


XT! 

1 


YT! 

l 


zt: 

i 


components of selected FHST X-axis unit vector 
along i ORC axis where i = X, Y, Z 

components of selected FHST Y— axis unit vector 
along i ORC axis where i = X, Y, Z 

components of selected FHST Z— axis unit vector 
along i ORC axis where i = x, Y, Z 

coefficients that relate magnetic field at 
selected FHST to the magnetic torquer bar coil 
currents where i = X, Y, Z (FHST axes), j = x, 

Y, Z (antenna boom coordinates) 

m = FHST 1 or 2 

The raw FHST position data are calibrated in six steps. Each 
step requires the evaluation of a polynomial of the follow- 
ing form: 


kf: . 

ii 


F(H, V, X, A t ) 


= A li + A 2i * V + A 3i * H + A 4i * X 


A * V 2 

A 5i V 

+ A gi * V * H + 

A 7i * v 

A * H^ 

A 8i H 

+ A 9i * H * X + 

A 10i * ' 

A * V 3 

A lli V 

+ A 12i * V 2 * H + A 13 . 

A 14i * V 

2 

* H + A * V 

15i V 

* H * X 

A 16i * V 

* X 2 + A 1? . * H 3 

+ A * 

18i 

A 19 i * H 

2 

* 



2 

* 
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where X^ denotes a vector composed of the coefficients 
A lif . .., A igi and H, V, X are scalars. In this polynomial, 
i is either 1 or 2, depending on whether the FHST is 1 or 2. 
"b\ , X , and X are defined similarly. The algorithm is as 
follows : 

1. Compensate horizontal and vertical measure- 
ments for flat field and temperature effects: 

HHT = F(H, V, TS, X^ + H 

WT = F(H, V, TS, X) + V 

where HHT and WT are partially calibrated 
FHST horizontal and vertical data. 

For these equations. 



where A*^ and B*^ are the BASD calibration 
coefficients . 

2. Compensate for star intensity variations: 


HHI = F(HHT, 

WT, 

IS, 

C i> 

+ HHT 

WI = F(HHT, 

WT, 

IS, 

X) 

+ WT 


where HHI and WI are partially calibrated 
FHST horizontal and vertical data. 
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For these equations. 


BHT 

BVT 

BBT 


and 




1.0 


°2i = °2*i 


1.0 


where and D*. are the BASD calibration 
coefficients . 

. Compute the Earth's magnetic field components 
along the FHST axes: 

BHF = BES X * XT£ + BES y * XT£ + BES Z * XT£ 

BVF = BES X * YT£ + BES * YT' + BES„ * YT 1 

* * z z 

BBF = BES X * ZT£ + BES y * ZT£ + BES Z * ZT£ 

where BHF, BVF, and BBF are components of the 
Earth's magnetic field along the FHST XT, YT, 
and ZT axes, respectively. 

Also, compute the total magnetic field at the 
FHST: 

BHF + KF^ * MDS X + KF^ * MDS y + KF£ Z * MDS Z 

BVF + KF^ * MDS X + KF^ * MDS y + KF£ Z * MDS Z 

BBF + KF' X * MDS X + KF' y * MDS y + KF^ * MDS Z 

where BHT, BVT, and BBT are components of the 
total magnetic field along the FHST XT, YT, 
and ZT axes, respectively. 
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Also, compensate for magnetic field variations 
along the ZT axis: 


HHM1 = F(HHI , 

WI, 

BBT, 

EB.) 

+ HHI 

WM1 = F(HHI , 

WI, 

BBT, 

FBj) 

+ WI 


where EB^, FB^ = coefficients describing 

FHST i 

HHM1, WM1 = partially calibrated FHST 
horizontal and vertical 
data 


For these equations. 


EB 3i 


EB 3*i 


- 1.0 


and 


FB 2i 


FB 2i 


- 1.0 


where EB|^ and FB*^ are the BASD calibration 
coefficients . 

Compensate for magnetic field variations along 
the XT axis: 


HHM2 = F(HHM1, 

WM1 , 

BHT, 

EH.) 

+ HHM1 

WM2 = F(HHM1 , 

WM1 , 

BHT, 

FH.) 

+ WM1 


where EHi, FH^ = coefficients describing 

FHST i 

= partially calibrated FHST 
horizontal and vertical 
data 


HHM2, WM2 


For these equations. 


EH 


3i 


EH 3*i 


1.0 


and 


FH 


2i 


™*2i 


1.0 


where EH^ and FH^ are the BASD calibration 
coefficients. 

Compensate for magnetic field variations along 
the YT axis: 


HHM3 = F(HHM2, WM2 , BVT, EV i ) + HHM2 
WM3 = F (HHM2 , WM2, BVT, FV^ ) + WM2 
PHIM = KST * HHM3 


THETAM = KST * WM3 


EVj, FVi = coefficients describing 
FHST i 

HHM3 , WM3 = calibrated FHST horizontal 
and vertical data in 
counts, respectively 

PHIM, THETAM = calibrated FHST horizontal 

and vertical data in 
radians 


For these equations. 


EV 


3i 


^3i 


1.0 


and 


FV 


2i 


FV|i 


1.0 
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6 . 


where EV*. and FV*. are the BASD calibration 

W X Z 1 

coefficients. 

Convert the compensated angles (PHIM, THETAM) 
to position coordinates: 

TPHI = PHIM * {1 + PHIM 2 [(1/3) + PHIM 2 * 2/15]} 


TTHETA = THETAM * {1 + THETAM 2 [( 1/3 ) + THETAM 2 * 2/15]} 

X = TTHETA 2 + TPHI 2 
ZSC = 1 - X/2 + (3/8)X 2 - ( 5/16)X 3 


XSC = -ZSC * TTHETA 


YSC = ZSC * TPHI 


where TPHI, TTHETA = calibrated FHST data in 

position coordinates 
(equations shown are suit- 
able approximations for 
tan PHIM and tan THETAM) 

X = intermediate parameter 

XSC = compensated FHST line-of- 
sight (LOS) unit vector 
component along the FHST 
X-axis 

YSC = compensated FHST LOS unit 
vector component along the 
FHST Y-axis 

ZSC = compensated FHST LOS unit 
vector component along the 
FHST Z-axis 


5132 


5-23 



Output STARDAT produces the following output: 
Description 

Tracked star intensity (magnitude) (to ATTEST) 

Compensated FHST LOS unit vector component alonq the 
FHST X-axis (to ATTEST) 

Components of FHST X-axis unit vector along i ACAD 
axis where i ■ X, Y, Z (to ATTEST) 

Compensated FHST LOS unit vector component along the 
FHST Y-axis (to ATTEST) 

Components of FHST Y-axis unit vector along i ACAD 
body axis where i = X, Y, z (to ATTEST) 

Components of FHST Z-axis unit vector along i ACAD 
body axis where i = X, Y, Z (to ATTEST) 

5 - 2 . 1.4 Wheel Ta chometer Data Processing 

The wheel tachometer data processing function computes the 
stored wheel momentum for each reaction wheel using the 
position data for each wheel from the reaction wheel elec- 
tronics assembly (RWEA) . 

• I nput Wheel tachometer processing uses the follow- 
ing input: 

Description 

KWSi Reaction wheel tachometer count-to-momentum conver- 
sion factor for wheel i for i=l to 4 (db) 

WHLi Reaction wheel i tachometer data (from Truth Model) 

MINIT Momentum computation initialization flag (= 0, do not 
initialize, = 1, initialize) (from MODECON) 

• Processing — Wheel tachometer processing must be 
performed every 256 msec but is used in the standby, normal 
pointing, and normal maneuver modes every 512 msec. It is 
performed prior to the computation of the reaction wheel 
control and distribution laws software function and the mag- 
netic control software function. 


Name 

IS 

xsc 

XTi 

YSC 

YTi 

ZTi 
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If initialization is required, the following code is per- 
formed: 

If MINIT = 1 Then 
OWHL i = WHL i 
MINIT = 0 

Endif 

The tachometer data from the Truth Model are converted from 
radians to counts. This is performed as indicated: 

CONRW. = KWS . * 0.256 sec/I 7 (I = 0.62547892 slug-ft 2 ) 
i x rw lw 

where I is the moment of inertia of a reaction wheel and 
rw 

0.256 sec is the cycle time. This was the calculated TRW 
stated capability of 393 ft-lbf-sec at 6000 RPM (Refer- 
ence 14) . 

The data from the Truth Model are then converted to counts: 

WHI^ = WHL i /CONRW ^ 

Next, the angular position change from the last computation 
cycle is computed for each reaction wheel, as follows: 

NW. = WHL. - OWHL . 
li l 

where NWj = change in reaction wheel i position tachometer 
counts and i = 1 to 4 

OWHLi = value of reaction wheel i tachometer counts 

from last cycle (see the following paragraphs) 
and i = 1 to 4 

These data are then limited to 2047 counts. 
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If |NW i | > 2047, 


N™i = NWi - 4096 * sign (WHI^) 

where 4096 is the total range of the tachometer register 
plus 1. 

Otherwise, there is no change in NW^ . 

The stored reaction wheel angular momentum for each reaction 
wheel i is then computed as 

HW. = KWS. * NW. 
i ii 

where HVT is the stored angular momentum for reaction 
wheel i, and i = 1 to 4 . 

Finally, the values of the reaction wheel i tachometer 
counts are saved for use in the next computation cycle 

OWHL^ = WHL^ for i = 1 to 4 

• Output Wheel tachometer processing has the follow- 
ing output: 

Description 

HWi Stored angular momentum for reaction wheel i where 
l = 1 to 4 (to MAGCON , WHECON) 

MINIT Momentum computation initialization flag; reset to 0 
by TACPRO (to MODECON) 

5.2. 1.5 Magnetomete r Data Processing 

The magnetometer data processing function accepts data from 
the TAMs and the MTAs and computes the net magnetic field at 
the TAM attributable to the Earth’s magnetic field. 

• Input The input for the magnetometer data process- 
ing module is described in Table 5-2. 
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Table 5-2. Magnetometer Data Processing (1 of 2) 


DEFINITION 

VECTOR 

NOMINAL 

VALUE 3 

UNITS b 

SOURCE 

DATA FROM MAGNETOMETER 1 
TAM ix 
TAM 1Y 
TAM 1Z 

Ym 

N/A 

TESLAS 

TRUTH MODEL 

DATA FROM MAGNETOMETER 2 
TAM 2X 
TAM 2Y 
TAM 2Z 

TAM 

N/A 

TESLAS 

TRUTH MODEL 

TORQUER BAR DIPOLE MOMENT 
MEASUREMENTS, TWO COILS 
PER AXIS 
DPM 1X 
DPM iy 
DPM 

DPfl 

N/A 

AMP-M**2 

TORQUE DRIVERS 

TORQUER BAR DIPOLE MOMENT 
MEASUREMENTS, TWO COILS 
PER AXIS 
DPM 2X 
DPM 2Y 
DPM 2Z 

dpK^ 

N/A 

AMP-M**2 

TORQUE DRIVERS 

MAGNETOMETER SCALE FACTOR 
KMS 


-.0003315 

GAUSS/ 

COUNT 

DATA BASE 

MAGNETOMETER DATA ZERO 
OFFSET COMPENSATION 
BO 



COUNTS 

DATA BASE 

COORDINATE TRANSFORMATION 
AND CONVERSION CONSTANT 
OF THE TORQUER BARS EFFECT 
ON THE MAGNETOMETER 
KByy 
KByy 
kb£ 

T 9* 

-5.662E-5 
-4.426 E-6 
-3.901 E-6 

GAUSS/ 

COUNT 

DATA BASE 

COORDINATE TRANSFORMATION 
AND CONVERSION CONSTANT OF 
THE TORQUER BARS EFFECT ON 
THE MAGNETOMETER 

kb vy 

KByy 

kb yz 

■Rf 

0.0 

1.923E-5 

-1.835E-5 

GAUSS/ 

COUNT 

DATA BASE 

COORDINATE TRANSFORMATION 
AND CONVERSION CONSTANT OF 
THE TORQUER BARS EFFECT ON 
THE MAGNETOMETER 

KB zx 

KB Z y 

KBzz 

"kB* 

1.656E-5 

2.184E-5 

2.083E-5 

GAUSS/ 

COUNT 

DATA BASE 
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Table 5-2. Magnetometer Data Processing (2 of 2) 


DEFINITION 


VECTOR 


NOMINAL 

VALUE 3 


UNITS* 5 


SOURCE 


MAGNETIC TORQUER 
SCALE FACTOR 
TDEj i — 3 


XTDE 


3x1.02228 


COUNT/ 

AMP-M**2 


DATA BASE 


TORQUER BAR SELECTION 
FLAG MAGFLD 

1 - TDE1 2 - TDE2 


N/A 


DATA BASE 


TELSA TO GAUSS CONVERSION 
TTOO 


1.0E+4 


GAUSS/ 

TESLA 


DATA BASE 


TORQUER BAR DIPOLE MOMENT 
ZERO OFFSET COMPENSATION 
Mq 


COUNTS 


DATA BASE 


COMPONENTS OF MAGNETIC FIELD 
BIAS VECTOR DUE TO 
NONTORQUER BAR ELEMENTS OF 
THE SPACECRAFT 
BB Y 
BB y 
BB, 


BB 


GAUSS 


DATA BASE 


MAGNETOMETER SELECTION 
FLAG SELMAG 
(1 - TAM 1) 

(2 - TAM 2) 


N/A 


DATA BASE 


DEFINITION 


VECTOR 


NOMINAL 

VALUE 3 


UNITS 


DESTINATION 


COMPONENTS OF EARTH'S 
MAGNETIC FIELD VECTOR ALONG 
SPACECRAFT AXES 
BE y 
BE y 
BE, 


BE 


<0.25 


GAUSS 


MAGNETIC 
CONTROL LAW, 
ATTITUDE 
ESTIMATION 


X, Y, Z TORQUER BAR GENERATED 
DIPOLE MOMENTS 
MD X 
MD y 
MD, 


MD 


N/A 


A/D 


ATTITUDE 

ESTIMATION 


? NOMINAL VALUE IS SINGLE PRECISION. 

D/A IS DIGITAL TO ANALOG; A/D IS ANALOG TO DIGITAL 
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• Processing — After it is determined which magnetom- 

eter is to be used, the zero offset of the raw measurements 
is removed, and the result is appropriately scaled to give 
the measured magnetic field. Figure 5-4 is the functional 
flow diagram. Next, the magnetic dipole moments for each 
axis generated by the magnetic torquer bars are computed. 
Finally, the measured magnetic field is compensated by sub- 
tracting these dipole moment contributions, along with any 
other spacecraft magnetic biases, to yield the net magnetic 
field of the Earth at the TAM. 

This software function receives input from magnetometer 
electronics and the torque drivers. It sends output to the 
attitude estimation algorithm (FHST calibration) and the 
magnetic control law (momentum management) for further proc- 
essing. These output data are the X-, Y-, and Z-components 
of the magnetic field at the magnetometer sensor being used. 
Magnetometer data processing is performed every 512 msec in 
modes that are TBD . 

Figure 5-4 shows how magnetometer data processing works. A 
flag, SELMAG, determines which magnetometer is to be used. 
The variables used in the following equations are further 
described in Table 5-2. 

Bq, a zero offset, is converted from counts to gauss, and 
the TAM data from the Truth Model are converted from teslas 
to gauss. Bg is then subtracted from the TAM data: 


B j = TTOG * TAMj - B Q ; j = X, Y, Z 

where KMS = conversion from counts to gauss 
TTOG = conversion from tesla to gauss 
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MAGNETOMETER 

DATA 

PROCESSING 



Figure 5-4. Magnetic Data Processing Flow 
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TAM i,j = raw magnetometer measurements for magne- 
tometer i where i = 1 or 2, component j = X, 
Y, Z 

Bj = components of the measured magnetic field j 
where j = X, Y, Z 

The torquer bar contribution to the measured magnetic field 
is then calculated. Using the MAGFIG flag, the proper 
torquer bar output is chosen and converted from amp-m 2 to 
counts; a torquer bar dipole moment zero offset is then sub- 
tracted : 


MD i = XTDE i * DPM ( MAGFIG, i) - M Q 

where XTDEi = conversion from amp-m 2 to counts 

M 0 = torquer bar dipole moment zero offset 
(counts) 

DPM ( i , j ) = torquer bar dipole moment measurement in 

MTA frame; i = X, Y, Z coordinate; j = TDE 
A/B 

In the following three equations, the net magnetic field of 
the Earth is computed by compensating the measured magnetic 
field (B x , By, B z ) for the effects attributable to the mag- 
netic torquer bars (MD X , MD y , and MD Z multiplied by a coor- 
dinate transformation matrix KB^, ..., KB ZZ to give the 
actual contributions with respect to the magnetometer coor- 
dinates and converted from counts to gauss) and the magnetic 
field bias attributable to all other nontorquer bar elements 
of the spacecraft (BB X , BB y , and BB Z ) : 

BE X = B X + (KB XX * + KB XY * MD Y + KB XZ * MI V + BB x 

BE Y = B Y + (KB YX * MD X + KB YY * MD y + KB YZ * MD Z ) + BB Y 

BE z = B z + (KB zx * ^x + KB ZY * md y + KB zz * MD Z > + BB Z 
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The magnetometer data processing function is updated every 
512 msec and is performed prior to updates for either the 
magnetic control law function or the FHST function. 

• Output — The output for the magnetometer data proc- 

essing module is described in Table 5-2. 

5. 2. 1.6 Star Data Averaging Function 

The star data averaging function (STARAVG) either (1) con- 
verts the raw FHST data to a form suitable for further proc- 
essing and computes the average of the four most current star 
position measurements for each of the two FHSTs or (2) sends 
out break-track commands to the FHST periodically. 


• Input — STARAVG uses the following input: 


Name 


Description 


SCPRSi 

SCMi 

STTi 

SCUi 

SCVi 

STRAVGi 

STLIM 

TFSCANi 

TSHij 

TSPRSij 


TSVij 


Star presence data from FHST i where i = 1 to 2 
(from Truth Model) 

Star magnitudes from FHST i where i = 1 to 2 (from 
Truth Model) 

FHST temperature data from FHST i where i = 1 to 
2 (constant in GROSS OBC but not in flight soft- 
ware) 

Raw FHST horizontal measurements, where i = 1 to 2 
(from Truth Model) 

Raw FHST vertical measurements, where i = 1 to 2 
(from Truth Model) 

Averaging function execution flag for FHST where 
i = 1 to 2 (from STARAVG, MODECON) 

Star data comparison threshold (DBC) 

Total FOV scan flag for FHST i, where i = 1, 2 
(from DBC, MODECON) 

Three previous raw FHST horizontal measurements 
where i ■ 1 to 2, j = 1 to 3, where j = 3 is the 
oldest (from STARAVG) 

Three previous raw FHST i star presence bits where 
i = 1 to 2, j = 1 to 3, where j = 3 is the oldest 
(from STARAVG) 

Three previous raw FHST vertical measurements 
where i = 1 to 2, j = 1 to 3, where j = 3 is the 
oldest (from STARAVG) 
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• Processing — This function is performed every 

256 msec in the standby mode and the normal pointing mode. 
It is performed before the attitude estimation function 
(ATTEST) . 

If TFSCAN^ = 0, the data averaging function is performed as 
follows (i = 1 to 2 in following discussions): 


H = SCU i 
V = scv i 

If SPRS i is true, PRS = 1; otherwise, PRS = 0 
Fin\ = sn\ 

FHM i = STM i 

where H = horizontal measurement from selected FHST 
V = vertical measurement from selected FHST 
PRS = star presence flag from selected FHST 
FHT^ = temperature measurement from selected FHST 
FHM^ = star magnitude measurement from selected FHST 

The previous star data values are set to the most current 
star data values if STARAVG was not performed in the pre- 
vious cycle: 


If STRAVG i = 0 
TSPRS i j = PRS 
TSH i j = H 

TSV ij = V 
STRAVG i = 1 

for j = 1 to 3 


where STRAVG i 
TSPRS i j 

TSH i: 

TSV ij 


averaging function execution flag 
three previous star presence flags 
three previous horizontal measurements 
three previous vertical measurements 
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The averages of the four most current tracker H- and V-axis 
measurements are computed if all four most current star 
presence flags are set to 1: 

If PRS = 1 and TSPRS n = 1 and TSPRS i2 = 1 and TSPRS i3 = 
FHHA i = (H + TSH^ 1 + TSH^ 2 + TSH i3 >/4 
FHVA i = (V + TSV^ x + TSV i2 + TSH i3 >/4 
IVASD i = 1 

Otherwise IVASD^ = 0 

where FHHA^ = averaged horizontal measurement for FHST i 

FHVA^ = averaged vertical measurement for FHST i 

IVASDi = valid averaged star data flag for FHST i 
(0=invalid, l=valid) 

Once the averaging has been performed, the averaged H- and 
V -ax is data are compared to the four most current star H- and 
V-axis data, respectively. If the difference between the 
averaged data and any one of the four most current star data 
exceeds the threshold, the valid averaged star data flag is 
reset to 0; otherwise, the flag remains set to 1. 

If IVASD i = 1 

then compare average to the four measurements as 


shown: 

If 1 FHHA. 
' 1 

- H | > 

STLIM or 


If 

1 

FHHA. 

1 

" TSH il 

1 > 

STLIM 

or 

If 

1 

FHHA. 

1 

" TSH i2 

1 > 

STLIM 

or 

If 

1 

FHHA i 

‘ TSH i3 

1 > 

STLIM 

or 

If 

1 

FHVA. 

l 

- V | > 

STLIM or 


If 

1 

FHVA i 

' TSV il 

1 > 

STLIM 

or 

If 

1 

FHVA. 

1 

- TSV i2 

1 > 

STLIM 

or 

If 

1 

FHVA. 

l 

- TSV i3 

1 > 

STLIM 


Then 

IVASD i 

= 0 





where STLIM — star data comparison threshold 
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The next step is to update the previous star data values and 
save the current star data. The variables with j = 3 will 
have the oldest star data: 

TSPRS^ j = TSPRSp “ for j = 3, 2 


TSH ij - 
TSV. . = 

tshP 

1) 

for 

j = 3, 

2 

TSV^ 

1) 

for 

j = 3, 

2 

ID 

l 





TSPRS il 

= PRS 






TSH i;L = H 
TSV il = V 

This completes the star-averaging portion of STARAVG. If a 
break track is commanded (TFSCAN^ = 1), the following 
processing is performed. A total field of view (TFOV) scan 
with break-track command to the selected FHST is issued 
every IBKTK computation cycle, and the corresponding valid 
averaged star data flag is set to zero (IVASD^ = 0) : 

ISTCNT i = ISTCITCV + 1 
If ISTCNT i = IBKTK Then 
CBT(i) = TRUE 
ISTCNT i = 0 

where ISTCNT^ = counter for TFOV function 
IBKTK = break-track command period 
CBT(i) = break-track command to FHST i 

The valid averaged star data flag and the averaging function 
execution flag are then reset: 

IVASD i = 0 
STRAVG. = 0 
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Output -STARAVG produces the following output: 


— Description 

CBT^ Break-track with TFOV scan commands to FHST i 

where i = 1 to 2 (to Truth Model) 

FHHAi Averaged FHST i horizontal measurement where i = l 

to 2 (to ATTEST) 

FHM^ Tracked star intensity (magnitude) where i = 1 to 

2 (to ATTEST) 


FHT A 

FHVAi 

ISTCNTj_ 

IVASDi 

STRAVGi 

TSHij 

TSPRSij 


FHST temperature where i = 1 to 2 (to ATTEST) 

Averaged FHST i vertical measurement where i = l 
to 2 (to ATTEST) 

TFOV function counter for FHST i where i = 1 to 2 
(to STARAVG) 

Valid averaged star data flag for FHST i where i = 
1 to 2 (to ATTEST) 


Averaging function execution flag for FHST i where 
l = 1 to 2 (to STARAVG) 


Three previous raw measurements for FHST i where 
STARAVG^ 2 ' j ' 1 t0 3 ' Wh6re j * 3 ° laeSt < t0 


Three previous raw FHST i presence bits where i = 
1 to 2, j = l to 3, where j * 3 oldest (to 
STARAVG) 


TSV 


ID 


Three previous raw vertical 
FHST i where i = 1 to 2, j 
oldest (to STARAVG) 


measurements for 
= 1 to 3, where j 


5.2.2 OBSERVATORY SUPPORT 


3 


The functions in the observatory support section compute the 
spacecraft ephemeris used by the antenna pointing command 
processing function to generate the HGA gimbal angles and 
gimbal slew commands as well as the spacecraft ephemeris and 
orbital geometry data used by the attitude estimation func- 
tion to determine the FHST occult at ion by the Earth. 

2 . 2.1 Ephemeris Com putation Function 

The ephemeris computation function (EPHEM) computes the cur- 
rent position and velocity of GRO and the positions of two 
TDRS satellites every 2.048 se C/ on the basis of GRO and 
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TDRS ephemerides computed on the ground and uploaded to the 
OBC . 

• Input — Input for EPHEM is as follows: 

Description 


Name 

GROPi 

GROVi 

TDREPj 

TDRWP-i 


Name 

GROPi 

GROVi 

TDREPj 

TDRWPi 


GRO current position in ECI coordinates where 
i = X, Y, Z (from Truth Model) 

GRO current velocity in ECI coordinates where 
i = X, Y, Z (from Truth Model) 

TDRS-East current position in ECI coordinates 
where i = X, Y, Z (from Truth Model) 

TDRS-West current position in ECI coordinates 
where i - X, Y, Z (from Truth Model) 

Process ina --No processing is performed in EPHEM. 

Output — Output for EPHEM is as follows: 

Description 

GRO current position in ECI coordinates where 

i = X, Y, Z (to ORIENT, OCCULT, ATTEST, ANTCON) 

GRO current velocity in ECI coordinates where 

i = X, Y, Z (to ATTEST) 

TDRS-East current position in ECI coordinates 
where i = X, Y, Z (to ANTCON) 

TDRS-West current position in ECI coordinates 
where i = X, Y, Z (to ANTCON) 


5. 2. 2. 2 Spacecraft Orientation Function 


The spacecraft orientation function (ORIENT) computes the 
orientation of the spacecraft +X and +Z axes in astronomic 
coordinates (right ascension and declination). The computa- 
tion is simply a coordinate transformation of the spacecraft 
attitude determined by the ACAD subsystem to right ascension 
and declination. 
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The orientation function also computes the elevation and 
azimuth of the Earth center in spacecraft body coordinates. 
This calculation is based on the position of the spacecraft 
in XYZ ECI coordinates from the ephemeris function combined 
with the spacecraft attitude data from ACAD. 

• Input— ORIENT uses the following input: 

Description 

EPA i Euler parameters specifying the attitude of the ACAD 
body axes with respect to ECI coordinates where i = 

1 to 4 (from KININT, DBC/GND) 

GROPj GRO position in ECI coordinates where i = X, Y Z 
(from EPHEM) 

QOAi Euler parameters (quaternion) specifying the mis- 
alignment of the observatory axes from the ACAD op- 
tical cube where i - 1 to 4 (data base constant) 

® ng — The computation is performed once every 

2.048 sec before execution of the occultation function and 
after execution of the ephemeris function. 

The right ascension and declination of the spacecraft +X and 
+Z axes are computed from the input ACAD Euler parameters, 
EPA^, as follows. 

First, the ACAD Euler parameters, EPAj, are transformed to 
the observatory Euler parameters, EPO., using the ACAD mis- 
alignment quaternion, QOA^ : 

EP0 1 = +QOA 4 * EPA ± + QOA 3 * EPA 2 - QOA 2 * EPA 3 + QOA 1 * EPA 4 

EP0 2 = ' Q0A 3 * EPA 1 + Q° A 4 * EPA 2 + Q° A i * EPA 3 + QOA 2 * EPA 4 

EP0 3 = +QOA 2 * EPA X - QOA 1 * EPA 2 + QOA 4 * EPA 3 + QOA 3 * EPA 4 

EP0 4 = - Q° A i * epa 1 - qoa 2 * epa 2 - qoa 3 * epa 3 + qoa 4 * epa 4 
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The elevation and azimuth of the Earth center in spacecraft 
coordinates are calculated as follows: Use the observatory 

Euler parameters, EPO^ to transform the input spacecraft 
position vector, GROP i , in ECI coordinates to E i in space- 
craft body Cartesian coordinates (D^ are intermediate vari- 
ables) and then transform -E i to spacecraft body spherical 
coordinates : 

P 1 = EP0 2 * GROP 3 - epo 3 * GROP 2 

P 2 = EP0 3 * GROP^ - EPC^ * GROP 3 

P 3 = EPO^ * GROP 2 - EP0 2 * GROP 1 

Q 1 = GROP 1 + 2 * (EP0 4 * Pi - EP0 3 * ? 2 ~ EP °2 * P 3 ) 

Q 2 - GROP 2 + 2 * <EP0 3 * + EP0 4 * P 2 - EPO x * P 3 > 

Q 3 = GROP 3 + 2 * (-EP0 2 * V 1 + EPOj^ * P 2 + EP0 4 * p 3 > 
GEOAZ = ARCTAN (-Q^-Q^ 

MAG(Q) = (Q x * Q x + Q 2 * °2 + °3 * Q 3* ** 1/2 
GEOEL = ARCCOS (-Q3/MAG(Q) ) 

The least significant bit for GEOAZ and GEOEL is 
IE-4 radians. 

• Output — ORIENT produces the following output: 

Name Description 

GEOEL Elevation of the Earth center measured from the 

+Z spacecraft axis (to OCCULT) 

GEOAZ Azimuth of the Earth center measured right-handed 

about the spacecraft +Z axis from the +X axis. (to 
OCCULT) 
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5. 2. 2. 3 Earth Occultat ion Function 

The occultation function (OCCULT) determines whether the 
FHST fields of view are occulted by the Earth. The deter- 
mmation is based on a calculation of the angular difference 
between the direction to the center of the Earth and the 
target direction combined with the angles subtended by the 
Earth and the FHST field of view. It is assumed that the 
fields of view are conical and the Earth is spherical. 

Thus, a field of view is occulted when the angular differ- 
ences are less than the sum of the half-angles subtended by 
the Earth and the field of view. 


The calculations are performed in spacecraft body coordi- 
nates. The direction to the Earth center is supplied by the 
spacecraft orientation function (ORIENT). The angle sub- 
tended by the Earth is computed from the orbital GRO XYZ 
position supplied by the ephemeris computation function. 

The target directions (in spacecraft body coordinates) and 
field-of-view angles are data base constants. 


• 

Name 

GEOAZ 

GEOEL 

GEORAD 

GROPi 

IFOVi 

INSAZi 

INSELi 


Input — OCCULT uses the following input: 
— Description 


Azimuth of the Earth center about the spacecraft 
Z-axis measured from the X-axis (from ORIENT) 

Elevation of the Earth center measured from the 
+Z spacecraft axis (from ORIENT) 

Radius of the Earth, defined for this computation 
to be 6500.0 km (DBC) 

GRO position in ECI coordinates where i = X, Y Z 
( f rom EPHEM) 

Half-angle field of view for FHST i where i = 1 to 
2 (DBC) 

Azimuth of the pointing direction of FHST i where 
i = 1 to 2 (DBC) 

Elevation of the pointing direction of FHST i where 
i = 1 to 2 (DBC) 
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• Processing — These computations are done once every 

2.048 sec, following execution of the ephemeris and orienta- 
tion functions. The computational accuracy of this function 
is IE-2 radians. 

Occultation is defined as an overlap of the solid angles 
subtended by the Earth and the FHST fields of view. The 
half-angle subtended by the Earth at the spacecraft (EANG) 
is computed using the spacecraft orbit radius (ORBRAD) and 
the radius of the Earth (GEORAD) : 

ORBRAD = (X ** 2 + Y ** 2 + Z ** 2) ** 1/2 

where X, Y, Z are the components of GRO position (GROP^ and 

EANG = ARC S I N ( GEORAD/ ORBRAD ) 

Then, for each FHST, the angular difference, ANG^ , between 
the instrument pointing direction, ANG^, between the FHST 
pointing direction ( INSEL^ , INSAZ i >, and between the direction 
to the Earth center (GEOEL, GEOAZ ) is computed using the 
cosine law: 

COS (ANG i ) = COS (INSEL i ) * COS (GEOEL) + SIN (INSEL.^ 

* SIN (GEOEL) * COS (INSAZ^^ - GEOAZ) 

for i = 1 to 2 

Occultation occurs if ANG^ is less than the sum of the half- 
angle subtended by the Earth and the half-angle field of view 
of the instrument: 

If ANG i < EANG + IFOV^^ for i = 1 to 2 

Then set status flag OCSTAT^ = 1, indicating that 
FHST i is occulted 

Else set status flag OCSTAT^ = 0, indicating that 
FHST i is not occulted 
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• Qvtpvt OCCULT produces the following output! 
— Description 


OCSTAT, 


Occultation status of FHST 1 (to ATTEST) 
l 2 Occultation status of FHST 2 (to ATTEST) 

5.2.3 ATTITUDE DETERMINATION 


OCSTAT, 


The GRO attitude determination system consists of the follow 
ing functions: kinematic integration (Section 5. 2. 3. 2), 

attitude error computation (Section 5. 2. 3. 3), and attitude 
estimation (Section 5. 2. 3. 4). Section 5.2.3. 1 is a brief 
system overview of the processing that occurs in each mode 
of operation. 


5. 2. 3.1 System Overview 

5.2.3. 1.1 Normal Pointing Mode 

The GRO attitude determination system is based on the concept 
of using precision gyros for high— bandwidth attitude data, 
with FHSTs or the FSS giving low-bandwidth attitude data that 
provide periodic attitude and gyro drift updates. A func- 
tional block diagram of the attitude determination system is 
shown in Figure 5-5. 

Between updates, the spacecraft attitude is determined from 
gyro data. The IRU output pulses are accumulated in the gyro 
pulse counter. They are sampled and are processed by the 
gyro data acquisition function to detect and compensate for 
gyro counter overflow, if required, and to prefilter the gyro 
data (Section 5.2.1.1.1). The data are then processed in the 
gyro data compensation function to compensate for known drift 
biases, scale factor, and alignment errors. The spacecraft 
angular increments and angular rates are also computed (Sec- 
tion 5. 2. 1.1. 2). The spacecraft angular increments are used 
by the kinematic integration function to propagate a set of 
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Figure 5-5. GRO Normal Pointing Mode Attitude Determination Functional 
Block Diagram 







Euler symmetric parameters that specify the attitude of GRO 
reference axes relative to the ECI coordinate frame (Sec- 
tion 5. 2. 3. 2). The reference attitude is specified in terms 
of the Euler symmetric parameters that define the orienta- 
tions of the mission reference frame relative to the ECI 
coordinate frame. The reference Euler symmetric parameters 
are then compared with the spacecraft Euler symmetric param- 
eters in the attitude error computation function to compute 
the attitude error (for roll, pitch, and yaw) vector (Sec- 
tion 5. 2. 3. 3). The attitude error vector is provided to 
various control processing functions, along with the space- 
craft angular rates. 

The attitude estimation function uses measurements from FHSTs 
and the FSS to update the spacecraft attitude and gyro drift 
biases (Section 5. 2. 3. 4). The normal mode of operation em- 
ploys measurements from two FHSTs; however, in the event of 
one FHST failure, the measurements from the other FHST and 
the FSS are used. 

Figure 5-6 shows the attitude estimation algorithm func- 
tional block diagram. A functional flow chart is shown in 
Figure 5—7. The attitude estimation algorithm starts by 
propagating the estimation error covariance matrix from the 
time of previous update to the current time. Propagation of 
the estimation error covariance matrix requires the computa- 
tion of a Kalman filter state transition matrix and a state 
noise covariance matrix. 

After covariance matrix propagation, the algorithm imple- 
ments a sensor selection logic to determine the proper sen- 
sor to provide the measurements. As in the Landsat-D update 
filter, the measurements are processed from one sensor at a 
time. The preferred sensor is the one that has gone the 
longer time without providing an update. If valid data are 
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Figure 5-7. 


Attitude Estimation Software Function 
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not available from the preferred sensor, the logic checks to 
see if valid data are available from the other sensor. If 
so, those data are used in an update; if not, attitude esti- 
mation processing is terminated. 

If an update is to be performed, the optimal gain matrix is 
computed; sensor data are used to estimate the attitude and 
gyro drift bias errors; and the estimation error covariance 
matrix is updated to reflect the effects of processing the 
sensor data. The position data from a sensor are considered 
to consist of a measurement vector containing two elements 
that are processed sequentially as two scalar measurements. 
Thus, two passes through the updating cycle are required. 

5. 2. 3. 1.2 Standby Mode 

During the standby mode, attitude estimation (Section 5. 2. 3. 4) 
is performed at intervals of 32.768 sec. Kinematic integra- 
tion (Section 5. 2. 3. 2) and attitude error computation (Sec- 
tion 5. 2. 3. 3) are performed at the cycle time of 512 msec. 

5. 2. 3. 1.3 Normal Maneuver Mode 

During normal maneuver mode, no attitude estimation (Sec- 
tion 5. 2. 3. 4) is performed. Kinematic integration (Sec- 
tion 5. 2. 3. 2) and attitude error computation (Section 5. 2. 3. 3) 
are performed at the cycle time of 512 msec. 

5.2.3. 1.4 Thruster Maneuver Mode 

During thruster maneuver mode, no attitude estimation (Sec- 
tion 5. 2. 3. 4) is performed. The gyro data prefilter is 
disabled, and kinematic integration (Section 5. 2. 3. 2) and 
attitude error- computation (Section 5. 2. 3. 3) are performed 
at the cycle time of 256 msec. 
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5.2.3. 1.5 Velocity Control Mode 

During velocity control mode, no attitude estimation (Sec- 
tion 5. 2. 3. 4) is performed. The gyro prefilter is disabled, 
and kinematic integration (Section 5. 2. 3. 2) and attitude 
error computation (Section 5. 2. 3. 3) are performed at the 
cycle time of 256 msec. 

5. 2. 3. 2 Kinematic Integration 

The kinematic integration function (KININT) uses the compen- 
sated gyro data to propagate the Euler parameters that spe- 
cify vehicle attitude relative to the ECI coordinate frame. 
It also uses the results of the attitude estimation function 
to update the Euler parameters and the gyro bias compensa- 
tion. 

The Euler symmetric parameters are propagated by the algo- 
rithms 


q <W 




cos B I + Jg Sin B 




q<t m> 


where q 
B 

e 

% 


Euler symmetric parameters 
0/2 

\l/2 


- ( e x * ®y + 


9 ' 


compensated gyro angular increments where i 
to 3 


= l 


I = 4-by-4 unit matrix 


0 0 3 *®2 ®1 

-®3 0 S 1 ®2 

®2 -®1 0 ® 3 
-®1 -®2 -®3 0 
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This equation is implemented by expanding the cosine and 
sine functions in a Taylor series, which is truncated after 
three terms. 

• Input — KININT uses the following input: 

Description 


Name 


EPAi 


SEi 


SE-; 


THETA i 


THETB i 


UPDATE 


ACAD attitude quaternion in ECI coordinates, 
where i = 1 to 4 (from KININT, Ground) 

Estimated roll, pitch, and yaw attitude determi- 
nation errors where i = 1, 2, 3 ACAD body axes 
(variables from attitude estimation function) 

Estimated roll, pitch, and yaw drift compensa- 
tion errors where i = 4, 5, 6 ACAD body axes 
(variables from attitude estimation function) 

Compensated gyro angular increments in roll, 
pitch, yaw where i = X, Y, Z ACAD body axes 
(variables from gyro data compensation function) 

Gyro drift errors, where i = 1 to 3 ACAD axes 
(from KININT, ground) 

Update filter flag where 0 = no update, 1 = 
update (flag from attitude estimation function) 


• Processing — KININT is executed every 512 msec in 
the normal pointing and normal maneuver modes and every 
‘256 msec in the velocity control and thruster maneuver 
modes. It is executed prior to the attitude error computa- 
tion, attitude and rate command processing, attitude esti- 
mation, and antenna pointing command processing functions. 

One-half the total gyro increment is computed as follows: 


B = 0.5 


^THETA^ 


+ THETAy + THETA^I• ** 0.5 


where B = one-half the total gyro angular increment. 
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One half (sin B)/B is computed using an approximation as 
follows : 


S = 0.5 * (1.0 - B 2 /6 + B 4 /120) 

where S is the approximation to one-half (sin B)/B. 
The cosine of B is approximated as follows: 


CB = (1.0 - B 2 /2 + B 4 /24) 
where CB is the approximation to cos B. 

Euler parameter increments are computed from the compensated 
gyro angular increment inputs THETA ^ and the values of 
Euler parameters computed the last cycle in KININT as 
follows : 


DA ! = S * <THETA Z * EPA 2 - THETAy * EPA 3 + THETA X * EPA 4 ) 


DA 2 = s * (-THETA Z * EPA X + THETA X * EPA 3 + THETAy * EPA 4 ) 


DA 3 = S * (THETAy * EPA X - THETA X * EPA 2 + THETA Z * EPA 4 ) 


DA 4 = S * (-THETA X * EPA X - THETAy * EPA 2 - THETA Z * EPA 3 ) 

where DAi = Euler parameter update increments and i = 1 
to 4 

EPAi = Euler parameters that specify the ACAD body axis 
orientation with respect to the ECI frame and 
x = 1 to 4 
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The Euler parameters are then updated by using these incre- 
ments after first multiplying by cos B: 

EPA i = CB * EPAj^ + DA^ 


for i = 1 to 4 . 

These Euler parameters are adjusted in sign depending on 

EPA„ as follows: 

4 

If epa 4 < 0, 


EPA.^ ■ -EPA^ for i = 1 to 4 


Otherwise, EPA^ is not changed. 

The Euler parameters are normalized: 


E = 0.5 * |3.0 - EPA^ - EPA^ - EPAg - EPA^ 


EPA^ = E * EPA^ for i = 1 to 4 


where E is the factor used to normalize the Euler parameters. 

Following the above process, KININT checks the update filter 
flag (UPDATE) from the attitude estimation module. 

If UPDATE is zero, the processing in KININT is complete, and 
the module is exited. 

Otherwise, new Euler parameter increments ( DAU ^ , i = 1 to 
4) are computed, and the Euler parameters are updated using 
the above equations, with THETA ^ replaced by SE^ as 
follows : 


, 1/2 


B = 0.5 * SE1* + SE2 + SE3" 1 
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S = 0.5 * (1.0 - B 2 /6 + B 4 /120) 

CB = (1. - B 2 /2 + B 4 /24) 

DAU^ = S * (SEg * EPA 2 - SE 2 * EPA 3 + SE 1 * EPA 4 ) 

DAU 2 = S * ( -SE 3 * EPAj^ + SE 1 * EPA 3 + SE 2 * EPA 4) 

DAU 3 = S * (SE 2 * EPA x - SEj^ * EPA 2 + SE 3 * EPA 4 ) 

dau 4 = S * (-SEj^ * EPA^ - SE 2 * epa 2 ~ SE 3 * EPA 3 ) 

where SE^ = estimated roll, pitch, and yaw attitude determi- 
nation errors and i = 1 to 3 ACAD body axes 

EPA i = CB * EPAi + DAUi for i = X, Y, Z 

If epa 4 <0, 

EPA. = -EPA i for i = 1, 2, 3, 4 
Otherwise, EPAi will not change. 

• ! ) 

EPA i = E * EPA t for i ~ 1 to 4 

Gyro drift errors are then updated as follows: 

THETB V = THETB V + SE. 

A X 4 


E = 0.5 


^ 3.0 - 


EPA 2 - EPA 2 - EPA 2 - EPA 
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THETB y 

= THETB y + 

SE 

THETB Z 

= THETB Z + 

SE 


where SE^ = estimated roll, pitch, and yaw rate bias com- 
pensation errors and i = 4 to 6 ACAD body axes 

THETBi = gyro rate compensation for roll, pitch, yaw 
where i = X, Y, Z ACAD body axes 


Finally, the update filter flag is set to zero (UPDATE = 0), 
and processing is complete. 


• Output — KININT produces the following output: 

Name Description 


EPAi Updated Euler parameters that specify the ACAD 

body axis orientation with respect to the ECI 
frame where i = 1 to 4 (to ATTEST, ATTERR, 
ANTCON, ORIENT, KININT) 

THETBi Gyro drift error in roll, pitch, yaw where 

i = X, Y, Z ACAD body axes (to GYRODAT, KININT) 

UPDATE Update filter flag; =0, no, =1, yes (to KININT) 


5. 2. 3. 3 Attitude Error Computation Function 


The attitude error computation function (ATTERR) uses the 
Euler symmetric parameters and Euler symmetric parameter 
commands to compute the attitude errors as shown below. 

• Input — ATTERR uses the following input: 

—Name Description 

ACADMD ACAD mode flag where 1 = standby, 2 = normal 

point, 3 = normal maneuver, 4 = Sun reference 
point, 5 = safehold, 6 = thruster maneuver, 7 = 
velocity control (flag set by mode module) 

Di Euler symmetric parameters that specify the com- 

manded observatory axes with respect to the ECI 
frame for normal pointing/maneuver modes where 
i = 1 to 4 (DBCs ) 
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Name 


Description 


DTCPi Euler symmetric parameters that specify the com- 

manded observatory axes with respect to the ECI 
frame for velocity/thruster control modes where 
i = 1 to 4 (variables from THRUSTR) 

EPAi Updated Euler parameters that specify the ACAD 

body axis orientation with respect to the ECI 
frame where i = 1 to 4 (variables from KININT) 

QOAi Euler symmetric parameters that specify the ob- 

servatory axes in the ACAD body axis frame where 
i = 1-4 (DBCs) 

• Processing — ATTERR is executed every 512 msec in 

the standby, normal pointing, and normal maneuver modes and 
every 256 msec in the velocity control and thruster maneuver 
modes. This software function is performed prior to the 
reaction wheel control and distribution, delta-V thruster 
control law, and low-level thruster control law software 
functions . 

The attitude commands used by ATTERR are first determined as 
a function of the ACADMD indicator as follows: 

If ACADMD =1, 2, 3, 4, or 5 (standby, normal pointing, 
normal maneuver. Sun reference, or safehold modes), then 

CMDTMP i = D i for i = 1 to 4 

If ACADMD = 6 or 7 (velocity control or thruster control 
mode) , then 


CMDTMPi = DTCPi for i * 1 to 4 

where CMDTMPi represents the Euler symmetric parameters 
(commanded values) used by ATTERR that relate the attitude 
reference frame to the ECI frame and i = 1 to 4. 
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The attitude commands are transformed from observatory to 
ACAD coordinates as follows, i.e., by performing the 
following quaternion product: 


^ Target q Target q Qbserv3t<?ry 

ACAD Observatory ACAD 


or, expressed as a matrix product: 


TARATT X 


-qoa 4 

QOA3 

-QOA 2 

QOA x 


CMDTMP^ 

taratt 2 


-QOA3 

-qoa 4 

QOA 1 

QOA 2 


cmdtmp 2 

taratt 3 

— 

QOA 2 

-QOAj^ 

-QOA 4 

qoa 3 


CMDTMP3 

TARATT. 

4_ 


-QOA 1 

-QOA 2 

-qoa 3 

-QOA 4 


CMDTMP. 

4_ 


NOTE : A question remains outstanding about the accuracy of 

this matrix. 

If TARATT 4 < 0, 

TARATT i = -TARATT i for i = 1 to 4 
Otherwise, TARATT^ does not change. 

Once the target quaternion is referenced with respect to ACAD 
coordinates, the error quaternion to transform the OBC 
quaternion to the commanded quaternion is derived as follows: 

q Target = q QBC__ * q E 
ACAD ACAD 


therefore. 


q E " q OBC * q Taroet 
ACAD ACAD 
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or, expressed as a matrix product: 



" C l" 


TARATT, 

4 

TARATT 3 

-TARATT 2 

TARATT x 


EPAj 


C 2 


-TARATT 3 

TARATT . 

4 

TARATT x 

taratt 2 


epa 2 


C 3 


TARATT 2 

-TARATTj 

TARATT, 

4 

taratt 3 


epa 3 


_ C 4_ 


-TARATT ^ 

-taratt 2 

-TARATTj 

TARATT . 

4 


-EPA, 

4 









If c. < 
4 

o. 








C. 

l 

= ^i 

for i = l 

to 4 



Otherwise, C i does not change. 

where C ± represents the error quaternion between the observed 
quaternion and the commanded quaternion, where i = 1 to 4 . 

Finally, the spacecraft body axes errors are computed as 

E = 2 * C 
X Z C 1 


E z - 2 - C 3 

where Ej^ represents the attitude errors in roll, pitch, 
and yaw, i.e., the commanded-minus-actual angles about the 
ACAD body, and i - X, Y, Z axes. 

• Qy, tPUt --ATTERR produces the following output: 

- Nam<? — Description 

Attitude errors in roll, pitch, and yaw, i.e. 
commanded-minus-actual angles about the ACAD 
body, and i = X, Y, Z axes (to LLTCON, HLTCON 
WHECON, SAFECON) ' ' 
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Name 


Description 


TARATT^ Euler symmetric parameters that specify the 

commanded ACAD body axes with respect to the 
ECI frame for normal pointing/maneuver modes 
(to ANTCON) 

5. 2. 3. 4 Attitude Estimation Function 

The attitude estimation function (ATTEST) uses data from the 
FHST or FSS to update the spacecraft attitude and gyro bi- 
ases. The normal mode of operation employs data from two 
FHSTs ; in the event of one FHST failure, the data from the 
other FHST and the FSS will be used. Every 32.768 sec, 

ATTEST generates roll, pitch, and yaw errors. These errors 
are fed into the kinematic integration function in place of 
the normal gyro data that are used between 32.768-sec up- 
dates . 

The attitude estimation function consists of an extended 
Kalman filter (KF) that is implemented in two steps. First, 
the internal statistics are propagated, based on the Dynamics 
Model; second, the state vector is updated based on the Ob- 
servation Model and the internal statistics. 

Dynamics Model 

The gyro rate measurement is assumed to have the following 
form: 

w - b - b + n 

~ 0 ~ V 

n 

— u 

gyro rate measurement 
true spacecraft rate 
gyro random walk error 
gyro bias 

float torque noise (Gaussian white noise) 
float torque derivative noise (Gaussian white noise) 


where @ 
w 
b 


n 

— v 
n 

— u 
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Since b is the integral of a white noise, it becomes a random 
walk. The gyro drift error e = Q - w, is formed as follows: 


£ = -bo - b + H v 

The gyro bias, b Q , is assumed to be known and can be taken 
out of the above equation. The attitude error tjr is computed 
as follows: i + w i j = g. However, since w is negligible, 

the dynamic model is reduced to the following form: 


= -b + n v 


b = n u 

If these two equations are put into a linear state space 
formulation, the following equations are derived: 


X(t) = F X(t) + W(t) 


X(t) = 

n 

— 

°3x3 

I 3x3 


at 

+ 

^(3x1) 


.b. 


°3x3 

°3x3_ 


.b. 


_ fl u(3xl) 


where = attitude error 

b = gyroscope random walk error 
riy = float torque noise (Guassian) 

= float torque derivative noise (Gaussian) 

The state equation is discretized to the following form: 

X(t k ) = 4> k X(t k _i) + W(t k ) 

AT 

where 4> k = e A1 k and T R = tfc - t fc _ 1 . 

The two characteristics of W(t) are the mean 

E [W(t ) ] = 0 
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and the covariance 


E[W(t) W T (t)] = 
where T denotes the transpose. 

Because it is assumed that there is no correlation between 
n and n , the off-diagonal elements in the above equation 
are zero. 

The spectral density matrix is defined as follows: 

Q(t) = E[W(t) W T (t)] 

Thus, the covariance is given as 

Q(t) 6<t-f) 

The discrete dynamics noise covariance matrix, Q k , is 
obtained using the state transition matrix, 4> k , and the 
spectral density matrix, Q(t), as follows: 


n n 


3x3 


3x3 


T 

n n 
— u — u 


6 ( t-t ' ) 


Q k 


/ 4>(t k , f) Q( t ' ) 4> T (t k , f) df 
fc k-l 


Pi ° ° P 3 

0 P x 0 0 

0 0 P x 0 

p 3 0 0 p 2 

0 P 3 0 0 

0 0 P 3 0 


0 

0 

p 2 

0 


0 

0 

P 3 

0 

0 

Po 
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where 


n v T k * 1/3 "u T k 


n 2 T, 
u k 


- 1/2 “k T k 


Q k is used in the propagation of the state covari 


ance 


matrix, P^, as follows: 


V-> = *k p k-i< t > *1 * o k 

where p k (~) = propagated covariance matrix at time k 
P k-1* + ) " u P da ted covariance matrix at time k-1 


In the GRO flight software, the FHST measurements are used 
to create an observed star unit vector, OS, in the sensor 
coordinate frame. The identified star position in the star 
catalog is used to create an expected or computed unit star 
vector, CS, in the sensor coordinate frame. The following 
is then defined: 

Z k (i) = OS.(i) - CS. (i) for i * 1 to 2 


where i is the ith coordinate of the vectors and Z. is the 
measurements residuals. 

From this definition of Z k , H k is shown to be 


(X x fi k ) r 

‘ k = a * V T 
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where £ k = observed star in spacecraft body frame 

X = FHST X-coordinate axis in the spacecraft frame 
Y = FHST Y-coordinate axis in the spacecraft frame 

In the observation model. 


*k " H k » + *k ' 

where Z k is the observation and Y k is the sensor noise 
(Gaussian) . 

The sensor noise characteristics are as follows: 

E[V k ] = 0 

E k - Et2 k ^i 11 - 

It is further assumed that the initial state vector, X Q , is 
Gaussian and that X Q , W, and V R are independent of each 
other. Because all are assumed zero mean and Gaussian, this 
is equivalent to assuming they are uncorrelated with each 
other . 

FSS Model 1 

As with the FHST, the FSS model uses an observed Sun posi- 
tion, OS, and a computed Sun position, CS, to compute meas- 
urement residuals, Z, as follows: 

Z k (i) = Q£ k (i) - ££ k (i) for i = x and y 



Reference 15 describes the FSS measurement model in more 
detail . 


5132 


5-61 



The measurement equation is the same as that for the FHST 
equation. For the FSS, the H k is shown to be 


H, 


<*MP * *k>‘ 


1x3 


1x3 


where £> k is the computed Sun vector, 
and Y Mp are defined as follows: * 


^SviPx “ ^ X Fx - Z Fx p * 

^MPy 

^SiPz 


= (X 


MPx 

^MPy 

f MPz 


= (X 
= (Y. 


Fy 


= (Y 


Fz 

Fx 

Fy 


z Fy XP)/(2 f . s k ) 
z F z xp >'<2 f • S k ) 
z Fx yp>/( 2 f • 3 k ) 
Z F y ™>'& v * S k > 

. A 


(Y Fz - Z Fz YP >'« F * S k ) 


where 


— F = X-coordinate axis in the spacecraft frame 

— F = FSS ^-coordinate axis in the spacecraft frame 

— F = F ®® Z-coordinate axis in the spacecraft frame 

XP and YP = FSS expected measurements 

The sensor noise characteristics for the FSS are the same as 
those for the FHST. 

Update Algorithms 

The state vector is updated by processing the following 
equation with the inputs P k (-), H k , R k , and the 
observation vector, Z. : 

K 


K = P ^-> H 


»w P fr (-) Hi + R, 


-1 
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where is the Kalman gain matrix: 

V> - (I - K k H k> p k<-> 

where ? k (+) is the updated covariance matrix: 

V + > - x k<-> + K k< z k - H k x k<->> 


where X k ( + ) is the updated state vector. 

The GRO flight software employs a scalar implementation 
method that requires the above sequence of equations to be 
executed twice. In the first pass, the following substitu- 
tions are made for the FHSTs (or similarly the FSS) : 

(X X s k > T o ll3 

R k = R k, 1 = R 11 

The resulting Kalman gain matrix, K^ ^ = K fc , is used to 
update the covariance matrix, where p k ^ = p k » and its 
update, where X k (-> = 0. The equations are as follows: 


H k - H k,i 


K k,i * p k<-> "k,^ 


H k,i p k<-> H k,i ♦ R k 


,1 


P k,l< + > - [I - « k>1 ] P k <-> 


X k,l<*> - *k,l Z k 


In the second pass, the following substitutions are made: 


H k = H k, 2 


(Y x S u ) 0 


1x3 


R k " R k, 2 " R 22 
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pass . 


K, 



K k 

■ K k, 

,2 



p k< 

-) 

“ P k, 

.1 



*k< 

-) 

- V 

1< 

o 


<+) 

is 

the state vector 

Kalman 

gain 

matrix. 

£ k 

ance 

matrix. 

p ] 

c< + > 

= P k 

to 

+ 

). 

The 

equations a 

p k. 

1 ( + 


2 / 

H k, 2 

P k, 

p k 

,2< 

+> - 

[I 

" % 

, 2 H : 

k< + > 

= 

S k (-) 

+ 

~k, 2 

[z k. 

is the 

Y-component 

of : 


-k,2 


• Input — The attitude estimation function uses the 

following data: 


Name 


Description 


AEOFF 


BE-i 


Cl 

CMDBKT 

EPAi 


Attitude estimation override flag; = 0, ATTEST 
on, = 1, ATTEST off (variable from DBC/GND) 

Components of Earth's magnetic field vector along 
spacecraft axes where i = X, Y, Z (variables 
from MAGPROC) 

Inverse of the speed of light (DBCs) 

Flag that determines if break track commands are 
allowed; = 0, commands not allowed, = 1, commands 
allowed (from MODECON) 

Updated Euler parameters that specify the ACAD 
body axis orientation with respect to ECI frame 
where i = 1 to 4 (variables from KININT, DBC/GND) 
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Name 


FHHAi 

FHMi 

FHTi 

FHVAi 

FHST 

FLTINIT 

GROPi 

GROVi 

HN 

HRFOVij 

IS 

ISLi 

ISUi 

IVASDi 

KS 

LSI xi 

LSIyi 

LSI zi 

MAXFOVi 


Description 

Averaged FHST i horizontal measurement where i = 

1 to 2 (from STARAVG) 

FHST i star intensity measurement where i = 1 to 

2 (from STARAVG) 

FHST i temperature measurement where i = 1 to 2 
(from STARAVG) 

Averaged FHST i vertical measurement where i = 1 
to 2 (from STARAVG) 

FHST selection; 1 = FHST 1, 2 = FHST 2 (from 
DBC/GND , ATTEST) 

Filter initialization flag (= 0, no initializa- 
tion, = 1, initialization) (variable flag from 
MODECON, ATTEST) 

GRO position in ECI coordinates where i = X, Y, 

Z) (variables from EPHEM) 

GRO velocity in ECI coordinates where i = X, Y, 

Z) (variables from EPHEM) 

FSS head select, bit 16 of FSS 2; = 0, sensor 1, 

= 1, sensor 2 (variable flag from FSSPROC) 

Horizontal offset pointing coordinates for FHST i 
where i = 1 to 2, j = 1 to 5 (DBC) 

Tracked star intensity (magnitude) (variable 
from STARDAT) 

Star catalog data, ith star magnitude lower limit 
where i = 1 to NCAMAX (DBCs) 

Star catalog data, ith star magnitude upper limit 
where i = 1 to NCAMAX (DBCs) 

Valid averaged star data flag for FHST i where 
i = 1 to 2 (from STARAVG) 

Nominal standard deviation for FHST acceptable 
accuracy (DBCs) 

Star catalog data, X-component of ith star unit 
vector in ECI frame where i = 1 to NCAMAX (DBCs) 

Star catalog data, Y-component of ith star unit 
vector in ECI frame where i = 1 to NCAMAX (DBCs) 

Star catalog data, Z-component of ith star unit 
vector in ECI frame where i = 1 to NCAMAX (DBCs) 

Maximum value of pointer NFOV^ for FHST i where 
i = 1 to 2 (DBC) 
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Name 


Description 


MDi 

NCAMAX 

NFALIM 


Components of torquer bar generated dipole moment 
in antenna boom coordinates where i = X, Y, Z 
(variables from MAGPROC) 

Number of stars in the OBC star catalog (DBC) 

Star identification failure threshold (DBC) 


NFOVO i 

OCSTATi 

OVRFOVi 

PA 0 

PG 0 

RF 

RL 

RLM 


RU 

RSN 

SCPlli 

Sli 

STj 

SUNPRS 

TB 

TA 

TF17 


Initial setting for pointer NFOVj where i = 1 
to 2 (DBC) 

Occultation status for FHSTs where i = 1 for 
FHST 1, i = 2 for FHST 2 (from OCCULT) 

Override flag for FHST offset pointing coordinate 
selection for FHST i where i = 1 to 2 (from DBC/ 
GND) 

Initial attitude error variance (DBC) 

Initial gyro bias variance (DBC) 

FSS measurement error variance (DBC) 

FHST measurement error variance for stars 
near the tracker origin (DBC) 

Measured star radius squared from FHST boresight 
for computation of measurement error variance 
(DBC) 

FHST measurement error variance for stars far 
from the FHST origin (DBC) 

Inverse of the mean distance from, the Earth to 
the Sun (DBC) 

Nominal value of maximum exponent of attitude co- 
variance elements PMll^ where i = 1 to 9 (DBC) 

Components of the Sun pointing unit vector from 
Earth in ECI coordinates where i = X, Y, Z (var- 
iables from EPHEM) 

FHST/FSS configuration flags where j = 1 to 4 
(data base flags) (see Table 5-4 for definition 
of bits) (DBC/GND) 

Sun presence flag, bit 32 of FSS4 (= 0, not 
present, = 1, present) (flag from FSS processor) 

Tangent of beta Sun angle in FSS coordinates of 
head in use (variable from FSS PROC) 

Tangent of alpha Sun angle in FSS coordinates of 
head in use (variable from FSS PROC) 

OBC clock time (variable from EXEC) 
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Name 


TFMOD 

TFSCANi 

TMD 

TPD 

TPSNOM 

VEi 

VGi 

VLOW 

VHIGH 

VRi 

Wi 

XFij 

XPC L 

XPCu 

XSC 

XTi 


YFij 


YPC L 

YPCu 

YSC 


Description 

OBC clock time modulus (DBC) 

Total FOV scan flag for FHST i where i = 1 to 2; 

= 1, TFOV scan, = 0, no TFOV scan (DBC/GND) 

Average FHST measurement time delay (DBC) 

Maximum allowed change in propagation interval 
without recomputing state transition matrix (DBC) 

Nominal value of propagation time interval (DBC) 

Components of Earth orbital velocity in ECI coor- 
dinates where i = X, Y, Z (variables from EPHEM) 

Gyro white noise drift for i = X, Y, Z axes (DBC) 

Minimum allowed value of FHST measurement resid- 
ual acceptable accuracy (DBC) 

Maximum allowed value of FHST measurement resid- 
ual acceptable accuracy (DBC) 

Gyro random walk drift variances where i = X, Y, 

Z (DBCs) 

Compensated spacecraft body rates in roll, pitch, 
yaw where i = X, Y, Z body axes (variables from 
GYRODAT) 

Components of ith FSS head X-axis unit vector 
along ACAD body axes where j = 1 to 3 , i = 1, 2 
(DBC) 

Lower FSS f ield-of-view limit for tangent of beta 
angle (DBC) 

Upper FSS f ield-of-view limit for tangent of beta 
angle (DBC) 

Compensated FHST LOS unit vector component along 
FHST X-axis (variables from star data processing) 

Components of FHST X-axis unit vector along i 
ACAD body axis where i = X, Y, Z (variables from 
star data processing) 

Components of ith FSS head Y-axis unit vector 
along ACAD body axes where j = 1 to 3, i = 1, 2 
(DBCs) 

Lower FSS FOV limit (tangent of angle) (DBC) 

Upper FSS FOV limit (tangent of angle) (DBC) 

Compensated FHST LOS unit vector component along 
FHST Y-axis (variable from star data processing) 
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Name 


Description 


YTi Components of FHST Y-axis unit vector along ith 

ACAD body axis where i = X, Y, Z (variables from 
star data processing) 

ZF^j Components of ith FSS head Z-axis unit vector 

along ACAD body axes where j = 1 to 3, i=l, 2 
(DBCs) 

ZTi Components of FHST Z-axis unit vector along ith 

ACAD body axis where i = X, Y, Z (variables from 
star data processing) 

• Processing — The attitude estimation function is 

executed every 32.768 sec. Attitude estimation data saving 
is accomplished at such a time that a consistent set of ACS 
data is saved. Figure 5-8 shows the processing flow of the 
attitude estimation function. 

Notations for Attitude Estimation — This subsection defines 
notation used in the remaining subsections and does not con- 
tain any specific functional requirements to be implemented. 
In addition to general notation definitions, the state tran- 
sition, error covariance, and state noise covariance matrices 
and their elements are defined. 

Ma trix [X] denotes a general 3-by-3 matrix. The elements of 
the matrix are defined as follows: 


[X] = 





It is assumed that the elements of the matrices are stored 
columnwise . 


5132 


5-68 




Figure 5-8. 


Attitude Estimation Overview Flow Chart 
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Vector — A general three-dimensional vector is denoted as V. 
The elements of the vector are defined as follows: 



or 

w = <V X , V Y , V z ) 


Transpose 

XPOSE [X] = Transpose of the matrix [X] . 

Dot Product 

DOT (A, B) =~A • ~B 
Cross Product 

CROSS (A, B) = ~A X ~B 

Vector Coordinate Transformation — The vector coordinate 
transformation transforms a vector from one coordinate frame 
to another when the Euler symmetric parameters that related 
the two frames are known. Let X be the vector to be trans 
formed; X the resulting transformed vector; o’ = [Q^, Q 2 , Q 3 , 
Q 4 ] the Euler symmetric parameters; and J, a flag indicating 
whether the direct or inverse transformation is to be used. 

The function is denoted as 

"B = XFORM (' A , "Q, J) 
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The processing is defined as follows: Save Q 4 in a tem- 

porary location: 


X = Q 4 

If J = -1, set X = -X; otherwise, there is no change to X. 
The following computations, are performed: 


D 1 ^2 * A 3 * A 2 


°2 - Q 3 * A 1 - Ql * A 3 


°3 " Q 1 * A 2 - * A 1 


B 1 - A ! + 2 * (X * D x - Q 3 * D 2 + Q 2 * D 3 ) 
b 2 = a 2 + 2 * ( x * d 2 - Q x * d 3 + q 3 * Q ± ) 


B 3 = a 3 + 2 * (X - D 3 - Q 2 * D x + Q x * D 2 ) 


State Transition Matrix — The state transition matrix is par- 
titioned into three 3-by-3 matrices, defined as follows: 


[FM n ] 


State 

transition 

matrix 

= 



” F 

11 

F 

12 

F 13 

where [FM^] 

= 

F 21 

F 

22 

F 23 



F 31 

F 

32 

F 33 


[i] 
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F 

r 14 

F 15 

F 16* 


[fm 12 ] - 

F 

24 

F 25 

F 26 



F 

34 

F 35 

F 36 


[I] = a 

3 -by- 3 

identity matrix 


Fij = elements of the state transition matrix that 
J relate the attitude errors to the initial at- 
titude errors for i = 1 to 3; j = 1 to 3 . For 
j = 4 to 6, these relate attitude errors to 
the gyro bias type of errors. 

Error Covariance Matrix — The error covariance matrix is par- 
titioned into four 3-by-3 matrices. The following diagram 
defines the notation 


Error covariance matrix 


[PM 11 ] t pM i2 ] 

[pm 21 ] [pm 22 ] 


wherq 




PM 111 

PM 114 

PM 117 

t™!! 1 

= 

PM 112 

PM 115 

PM 118 



PM 

113 

PM 

™116 

PM 119 



PM 

121 

PM 

124 

PM 127 

[pm 12 ] 

= 

PM 122 

PM 125 

PM 128 



_ PM 123 

PM 126 

PM 129 

CPM 21 ] 

= XPOSE [PM 

12 ] 




PM 221 

PM 

224 

PM 

227 

[pm 22 ] 

= 

PM 222 

PM 

225 

PM 228 



PM 223 

PM 

226 

PM 229 


5132 


5-72 



PMni = elements of the attitude error covariance 
matrix, where i = 1 to 9 

PMi 2 i = elements of the cross covariance matrix be- 
tween the attitude and gyro bias errors, where 
i = 1 to 9 

PM 22i = elements of the gyro bias error covariance 
matrix, where i = 1 to 9 


State Noise Covariance Matrix — The state noise covariance 
matrix is a symmetric matrix whose elements are defined as 
follows : 



W lll 

W 112 

W 113 

W 121 

W 

124 

W 

127 


W 112 

W 114 

W 115 

W 122 

W 

125 

W 

128 

State 

noise 

W 113 

W 115 

W 116 

W 123 

W 

126 

W 

129 

covariance = 
matrix 

W 121 

W 124 

W 127 

W 

221 

0 

0 


W 122 

W 125 

W 128 

0 

W 

222 

0 


W 123 

W 126 

W 129 

0 

0 

W 

223 


where W. . . represents elements of 

l n K 


matrix . 


state noise covariance 


Attitude Estimation Data Savina — Table 5-3 lists the input 
data variables that are saved at the beginning of ATTEST and 
are then used during the computation cycle of ATTEST. The 
acronyms under which the variables are saved and used in 
ATTEST are also shown in the table. These data will be ob- 
tained at times that result in a consistent data set. The 
saved data that are outputs of KININT, MAGPROC, EPHEM, 
GYROCOMP, FSSPROC, and OBCEXEC are sampled after these mod- 
ules have executed. The FHST data is sampled at a consistent 
time near the sampling time of the other data. 
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Table 5-3. Saved Attitude Estimation Data 


DATA DESCRIPTION 

DATA 

SOURCE 

INPUT 

DATA 

SYMBOL 

SAVED DATA, SYMBOL 

FHST DATA: 

HORIZONTAL MEASUREMENT 
VERTICAL MEASUREMENT 
FHST INTENSITY 
FHST TEMPERATURE 
VALID AVERAGED STAR DATA FLAG 

STARAVG 


FHHASj FOR i = 1 , 2; j = 1 , 2 
FHVASj FOR 1.1,2; J. 1,2 
FHMSj FOR i = 1, 2 
FHTSj FOR i = 1,2 
STARUj FOR i. 1,2 

ECI EULER PARAMETERS 

KININT 

EPAj 

SEPAj FOR i = 1 to 4 

MAGNETIC FIELD COMPONENTS 

MAGPROC 

BE f 

BESj FOR i = X, Y, Z 

MAGNETIC TORQUER BAR MOMENTS 

MAGPROC 

MDj 

MDSj FOR i = X, Y, Z 

ORBIT POSITION 

EPHEM 

GROPj 

RXSj FOR i =1 TO 3 

ORBIT RATE 

EPHEM 

GROVj 

VXSj FOR i = l TO 3 

SPACECRAFT BODY RATES 

GYRCOMP 

Wj 

WUj FOR i = X, Y, Z 

FSS DATA 

FSSPROC 

SUNPRS 

SUNPS 



HN 

HEAD 



TA 

XPC 



TB 

YPC 

SUN UNIT VECTOR 

EPHEM 

SI 1 

SIXSj FOR I = 1 TO 3 

EARTH ORBITAL VELOCITY 

EPHEM 

VE, 

VEXSj FOR i = TO 3 

OCCULT ATION STATUS 

OCCULT 

OCSTATj 

OCSTATSj FOR 1 = 1,2; j = 1,2 § 

OBC CLOCK DATA 

OBCEXEC 

TU 

3 

CM 

CO 
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Attitude Estimation Override bv Ground Command — The ATTEST 
function is not to be executed if the AEOFF flag is set by 
ground command: 

If AEOFF = 1 

FLTINIT = 1 
Exit ATTEST 

where AEOFF = attitude estimation off-flag 

FLTINIT = update filter initialization flag 

Otherwise, process ATTEST function. 

Attitude Estimation Initialization — If the attitude estima- 
tion initialization flag FLTINIT is set to one, the following 
attitude estimation initialization computations will be per- 
formed : 


pM Hi = 0 i = 1 , 2 , . . . , 9 


PM 111 = PM 115 PM 119 PA 0 


PM 12i =0 i=l/2, . . . , 9 


PM 22i =0 i=l/2, . . . , 9 


PM 221 = PM 225 = PM 229 = PG 0 


TPS = 0 


FLTINIT = 0 


TUS = TU - TPSNOM 
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NFAIL i =0 i = 1,2 

LSTID i =0 i = 1,2 

NFOV i = NFOVO i i = 1,2 

FSS = 0 

where TPS = past value of covariance matrix propagation in- 
terval 

TUS = value of TU at last covariance matrix propagation 
TU = saved OBC clock time (see Table 5-3) 

If FLTINIT is not equal to one, no initialization computa- 
tions are performed. 

Stflte Transition and State Noi s e Matrices — The state transi- 
tion and state noise covariance matrices are a function of 
the propagation time interval, which is computed as follows: 

TPI = TU - TUS 

where TP is the covariance matrix propagation interval. 

If | TP TPS | < TPD, the change of the propagation interval 
is small, and the state noise covariance matrix is not recom- 
puted. The remainder of the processing in this subsection 
is not performed in this case. In the above, TPD is the 
maximum allowed change in propagation interval (without re- 
computing the state transition matrix) . 

If | TP - TPS | > TPD, the change of the propagation interval 
is large, and the remaining computations in this subsection 
are performed: 
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The current propagation interval is saved as follows: 

TPS = TP 

where TPS is the past value of covariance matrix propagation 
interval . 

Intermediate quantities used in computing the state transi- 
tion and state noise covariance matrices are computed: 

T 2 = TP 2 /2 


T 3 = TP /3 


The elements of the state transition matrix are computed: 


11 


12 


13 


21 


22 


23 


31 


32 


33 


14 


15 


1 

0 

0 

0 

1 

0 

0 

0 

1 

-TP 

0 
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0 


16 


24 


25 


26 


34 


35 


36 


0 

-TP 

0 

0 

0 

-TP 


The elements of the state noise covariance matrix are com- 
puted: 


W m - 

VG X * TP + VR X * T 3 

W 112 » 

0 

W 113 - 

0 

W 114 = 

VG y * TP + VI^ * T 3 

W 115 = 

0 

W 116 = 

VG_ * TP + VR_ * T 

" L j 

W 121 " 

-VR * T 
X l 2 

W 122 “ 

0 

W 123 = 

0 

W 124 " 

0 

W 125 = 

- vr y * t 2 
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0 


w 

w 

w 

w 

w 

w 

w 


126 

127 

128 
129 
221 
222 
223 


0 

0 

-VR Z * T 2 
VR X * TP 
VRy * TP 
VR Z * TP 


where VR^ represents gyro random walk drift variances and 
i = X, Y, Z. 

Covariance Matrix Propagation — The attitude estimation error 
covariance matrix propagation algorithm is specified as fol- 
lows : 

Compute various intermediate matrices: 


[x 1 ] 


[FM 11 ] [PM i;l ] 


[x 2 ] 


XPOSE [FM^] 


[PMn] 


[x 1 ] 


[X 1 ] [X 2 ] 


= [fm i;l ] [pm 12 3 


[X 2 ] 


= [fm 12 ] [pm 22 ] 


Propagate elements of [PM 12 ] : 


PM 12i = X li + X 2i + W 12i i = 1 to 9 
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Compute various intermediate matrices: 

[X 3 ] = XPOSE [FM 12 ] 

[x 4 ] = [x x ] [x 3 ] 

[X 1 ] = [X 2 ] tX 3 ] 
Propagate elements of [PM 11 ] : 


PM 111 

= 

PM 111 

+ 

2 * 

X 41 + 

X 11 + 

W lll 

PM 115 

= 

PM 115 

+ 

2 * 

X 45 + 

X 15 + 

W 114 

PM 119 

= 

PM 119 

+ 

2 * 

X 49 + 

X 19 + 

W 116 

PM 

112 

= 

PM 112 

+ 

X 42 

+ X 44 

+ X 12 

+ W 112 

PM 113 

= 

PM 113 

+ 

X 43 

+ X 47 

+ X 13 

+ W 113 

PM 116 

* 

PM 

116 

+ 

X 4 6 

+ X 48 

+ X 16 

+ W 115 

PM 

114 

= 

PM 112 






PM 

117 

- 

PM 113 






PM 

118 

= 

PM 116 







Propagate elements of [PM 22 ] : 


PM 221 

= PM 

221 

+ 

W 221 

PM 225 

= PM 

225 

+ 

W 222 

PM 

229 

= PM 

229 

+ 

W 223 

PM 

224 

= PM 

222 




5132 


5-80 



PM 227 PM 223 


PM 228 * PM 226 


Measurement Processing — The measurement processing require 
ments are presented in Figure 5—9 and the paragraphs of this 
subsection as referenced by Figure 5-9. Measurement proc- 
essing also calls the STARDAT module. 

The measurement processing logic determines if valid sensor 
data are available, and if so, selects the proper sensor to 
provide the update data. Two attitude estimation sensor 
configurations are provided for as indicated by the sensor 
configuration flag, ST. (Table 5-4 defines the bits of ST 
and of the other flags and counters used in ATTEST.) The 
logic determines if valid data are available from the sensor 
that has gone the longest time without providing update data. 
If valid data from this sensor are available, they are used 
in the update. If valid data from the preferred sensor are 
not available, the logic checks to see if valid data are 
available from the other sensor. If so, these data are used 
in the update. If neither sensor has valid data, measurement 
processing is terminated. 

FHST Data Correction — The FHST data correction function com- 
pensates the FHST measurements for the effects of velocity 
aberration and measurement time delay. The input to this 
function consists of the compensated FHST measurements from 
STARDAT . 

The required processing is as follows: 

The total aberration velocity is computed: 


VA = VXS + VEXS 
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1 FHSTs ONLY 


STARU(FHST) -1? ) TRACKING A STAR ? 


FHST DATA CALIBRATION 


FHST DATA CORRECTION 


STAR IDENTIFICATION 


ONLY ONE STAR MATCHES 
THE MEASURED STAR? 



NO VALID DATA 


VSD -1 

IENUPD -0 1FST(FHST+1)-1 
- 1 OTHERWISE 
FHST - 3 - FHST 


VALID DATA 


Figure 5-9. ATTEST Measurement Processing (2 of 3) 











Figure 5-9. ATTEST Measurement Processing (3 of 3) 
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Table 5-4. Flags and Counters Used by ATTEST (1 of 2) 


Flags 


Counters 


FLTINIT Update filter initialization flag (external flag 
from MODECON): 

= 1 , initialize update filter 
= 0 , do not initialize filter 

FHST FHST pointer (internal flag): 

= 1, use data from FHST 1 
= 2, use data from FHST 2 

FSS Flag that indicates if the FSS is the preferred up- 

date sensor (internal flag to switch usage between 
FSS and FHST): 

= 1, FSS is the preferred sensor 
= o, FSS is not the preferred sensor 

IENUPD Update inhibited/not inhibited for sensor being 
process (internal flag): 

= 0, update is inhibited according to ST bit corre- 
sponding to sensor in question 
= 1, update is not inhibited according to ST bit 
corresponding to sensor in question 

ISC Counter of the number of stars that pass the star 

identification criteria (internal counter) 

PASS Sensor measurement processing counter (internal 

flag) : 

= 1 , first measurement processed 
= 2, second measurement processed 


ST- 


Sensor configuration flag (OBC set by ground) : 
STi = 0/ use FSS and one FHST (as indicated by 
flag "FHST") 

= 1/ use two FHSTs 
ST 2 = 0, FHST 1 not inhibited 
= 1, FHST 1 inhibited 
ST 3 = 0, FHST 2 not inhibited 
= 1, FHST 2 inhibited 
ST 4 = 0, FSS not inhibited 
= 1, FSS inhibited 


STARUj Star presence flag for ith FHST (renamed from 
IVASD^ , which comes from STARAVG) : 

= 1 , star data available 
= 0 , no star data available 

SUNPS FSS Sun presence flag (external flag): 

= 1, Sun in the FSS FOV 
= 0, Sun not in the FSS FOV 
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Table 5-4. 


Flags and Counters Used by ATTEST (2 of 2) 


Flags 

AEOFF 

TRY 

UPDATE 

VSD 


Counters 


Attitude estimation flag (from DBC/GND) 

= 0, proceed with ATTEST processing 
= 1, do not execute ATTEST 

Update sensor sequence counter (internal flag): 

= 1, data from first (i.e., preferred) update sensor 
has been checked 

= 2, data from both update sensors has been checked 

Update ready flag- (external flag set by ATTEST for 
use by KININT) : 

= 1, updates are ready 
= 0, updates are not ready 

Valid sensor data flag (internal flag): 

= 1, valid sensor measurement available 
= 0, no valid sensor measurement available 


5132 


5-86 



where VXS = (VXS.^ VXS 2 , VXS 3 ) 

VEXS = (VEXS x , VEXSy. , VEXS z ) 

VXS^ = saved orbit rates (Table 5-3) 

VEXSi = Earth orbital velocities (input to ATTEST), 
i = X, Y, Z 


This computation is transformed to ACAD body axis coordi- 
nates : 

VAV = XFORM(VA, SEPA, -1) 

where VAV = total star aberration velocity vector in ACAD 
body axes 

SEPA = vector of saved Euler parameters (see Table 5-3) 

The projections of the aberration velocity are computed along 
the FHST X- and Y-axes: 


XSA = DOT (XT, VAV) 

YSA = DOT(YT, VAV) 

where XT = (XT X , XT y , XT Z ) 

YT = (YT X , YT y , YT Z ) 

XT., YT i = input from STARDAT 

The aberration corrections are computed along the FHST X- and 
Y-axes : 


XSA = Cl * XSA 
YSA = Cl * YSA 

where Cl is the inverse of speed of light (DBC) . 

The FHST measurements are compensated for aberration error: 

XS = XSC - XSA 

YS = YSC - YSA 
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where XS, YS = components of compensated FHST measurements 

(LOS unit vector) corrected for velocity- 
aberration (in FHST axes) 

XSC, YSC = components of compensated FHST calculated 
in STARDAT 

The Z-component of the compensated/corrected measured star 
is computed: 


ZS = SQRT ( 1 - XS * XS - YS * YS) 

The compensated/aberration corrected star unit vector is 
transformed to ACAD body coordinates: 


LS 1 

X 

II 

* 

XS 

+ 

YT 

x 

* 

YS 

+ 

ZT x 

* 

ZS 

LS 2 

= XT y 

* 

XS 

+ 

YT 

Y 

* 

YX 

+ 

zt y 

* 

ZS 

LS 3 

= XT Z 

* 

XS 

+ 

YT Z 

* 

YS 

+ 

ZT Z 

* 

ZS 


The measurement matrix components are computed for later use: 


HI = CROSS (XT, f^S) 


H2 » CROSS (YT, LS) 


where HI = measurement vector (matrix component) for 
X-measurement 

H2 = measurement vector (matrix component) for 
Y-measurement 

Compute the star LOS rate vector in ACAD body coordinates: 


LR = CROSS (LS, WU) 

where LS 
WU 
WU i 


= (LS 1 , LS 2 , LS 3 ) 

= (WU X , WU y , WU Z ) 

= saved body rates, i = X, Y, Z 
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Measurement rates are computed along the FHST X- and Y-axes: 

XSD = DOT (XT, LR) 

YSD = DOT(YT, LR) 

Compute time delay corrections: 

XSD = XSD * TMD 
YSD = YSD * TMD 


where TMD is the average measurement time delay (DBC) . 

Time delay errors are compensated for as follows: 

XS = XS + XSD 

YS = YS + YSD 

where XS, YS are components of compensated star position 
corrected for velocity aberration and measurement time delay 
(in FHST coordinates). 

Star identification — The star identification module deter- 
mines if the star currently being tracked is in the active 
star catalog, and, if so, exactly which star it is. First, 
the measurement noise variance and an acceptance accuracy 
for the measurement residuals are computed, followed by a 
transformation of the FHST axis unit vectors to ECI coordi- 
nates. Next, a star catalog is searched for stars satisfying 
both of the following two criteria: 

• The magnitude of the tracked star is within the 

upper and lower magnitude limit of the star in the 
catalog 
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• The measurement residuals are within an acceptable 
value 

For a valid star to have been found, only one star in the 
catalog must pass the above criteria. More than one star 
passing the tests results in no valid star and the issuance 
of the break track command with offset pointing coordinates. 

First, the measurement noise variances are computed, depend- 
ing on the measured star location in the FHST FOV: 

RTP = XS * XS + YS * YS 

If RTP > RLM set R = R ; otherwise, set R = R : 

^ L 


R 2 . R 

where R = FHST measurement variance 

R 1 = measurement variance for X-measurement 

R 2 = measurement variance for Y-measurement 

= radius sguared of star position measurement 
from the tracker null 

R L» R U = measurement variances for stars near or far, 
respectively, from origin (DBC) 

Next, the acceptance accuracy is computed as a function of 
attitude error covariance elements: 

SCP H = MAXIMUM {EXPONENT [PM m ] for i « 1, 2, . . . , 9 } + 1 
VS 1 = KS * 2^ SCP 11 “ SCP 11I )/2] 
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Limit VS 1 as follows: 


V 


LOW 


< VS, 


< V 

- HIGH 


VS 


2 



maximum exponent of attitude covariance 
elements i = 1/ 2, . 9 

maximum value of the elements in {} 

exponent of X^ when X^ is expressed as 
a mantissa and exponent with the expo- 
nent in powers of 2. The exponent is 
the same as the NSSC-1 scaling stored 
in the exponent word for floating-point 
values in the NSSC-1 

SCPm = nominal value of SCPn (DBC) 

VSi = measurement residual acceptable accuracy 
criteria for the X-axis FHST measurement 

VS? = measurement residual acceptable accuracy 
criteria for the Y-axis FHST measurement 

v LOW' V HIGH = minimum, maximum acceptable accuracy for 
measurement residuals (DBCs) 

The FHST unit vectors are then transformed to ECI coordi- 
nates : 


where SCPn = 

MAXIMUM {} = 
EXPONENT [Xi] = 


XT I = XFORM(XT , SEPA, +1) 

YTI = XFORM(YT, SEPA, +1) 

where XTI = FHST X-axis unit vector in terms of ECI compo- 
nents 

YTI = FHST Y-axis unit vector in terms of ECI compo- 
nents 
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The onboard star catalog contains the number of stars in the 
catalog (NCAMAX) and the following information for each 
star i in the catalog for i = 1 to NCAMAX: 


Star magnitude upper limit 

Star magnitude lower limit 

Star unit vector in ECI 
coordinate frame 


ISIL 

ISL i 

LSI Xi 

LSIyi 

LSI zi 


The star catalog search processing is as follows: 


Step 1 : Initialization: 


ISC = 0 
n = 1 

where ISC = counter of number of stars that pass the star 
identification criteria 

n = star catalog search counter 
Step Z> Star intensity is checked for: 

If (IS > ISL n ) and (IS < ISU n ) 

Step 3 follows; otherwise, step 5 is next. 

Step 3; Measurement residuals are computed: 

SX = DOT ( XT I , LSI ) 

n 

SSX = XS - SX 
SX = ABS(SSX) 

SY = DOT(YTI , LSI n ) 
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SSY = YS - SY 


SY = ABS(SSY) 

where LSI n = (LSIX n , LSIY n , LSIZ n ) 

SSX, SSY = components of FHST measurement residuals 
(along FHST X- and Y-axes) 

SX, SY = components of the nth catalog star initially 
and then the absolute values of the measure- 
ment residuals 

Step 4 : Acceptable measurements residuals are tested for: 


If (SX < VS^ and (SY < VS 2 ) 


ISC = ISC + 1 
ISTR = n 
z 1 = SSX 
Z 2 = SSY 


where ISTR = star catalog sequence number of last accepted 

star 

z l» z 2 = updated sensor measurement residuals (used in 
a later subsection on Euler Symmetric Param- 
eter and Gyro Bias Correction) 

Step 5 : 


n = n + 1 


If (n > NCAMAX) , step 6 follows; otherwise, step 2 follows. 
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&£££ — 6. • If ISC ^ 1 (that is, other than one star passes 

the test), no valid star has been identified, and the fol- 
lowing is performed: 

NFAIL(FHST) = 1 + NFAIL(FHST) 

LSTID(FHST) = -1 

where NFAIL(i) = number of star identifications failed and 

i = 1, 2 for FHST 1 or 2 

LSTID(i) = catalog number of last star identified and 
i = 1, 2 for FHST 1 or 2 

If ISC = 1 (only one star passes the test), a valid star has 
been found, and the following is performed: 

NFAIL(FHST) = 0 

If ISTR is not equal to LSTID(FHST) , 

LSTID(FHST) = ISTR 
ISC = -1 

FHST Offset Pointing Coordinates Selection — The function of 
the FHST offset pointing coordinates selection module is to 
provide updated RFOV offset pointing coordinates to the FHST 
for the purpose of acquiring and tracking a valid guide star. 
The offset pointing coordinates are selected from an onboard 
data table. The pointer that determines the coordinates to 
be used is incremented each time this module is executed. 

The module shall be executed 

• When no star is being tracked (STARU(FHST) = 0) or 

• When the star being tracked is not a valid guide 
star (ISC < > 1 and NFAIL (FHST) < > 0) 
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The module is not executed 


• During FHST occupation (OCSTATS(FHST) - 1 or 

• If the override flag (OVRFOV) is set by ground com- 
mand or 

• If the FHST is operating in the TFOV scan mode or 

• If valid averaged star data exists for the FHST and 
the number of star identification failures is less 
than the limit 

The FHST offset pointing coordinate selection processing is 
as follows: 

Step 1 

If (OCSTATS (FHST) = 1 ) or 
(OVRFOV (FHST) = 1 ) or 
(TFSCAN (FHST) = 1 ) or 

(STARU (FHST) = 1 AND NFAIL (FHST) < = NFALIM ) 

Then do not execute the module 

where OCSTAT.. = FHST occultation status for j=FHST+10 
OVRFOV = override flag 
TFSCAN = total FOV scan flag 

NFALIM = star identification failure threshold 
Otherwise, proceed on to Step 2. 

Step 2 

NFOV(FHST) = NFOV(FHST) + 1 

If NFOV(FHST) > MAXFOV ( FHST ) Then NFOV(FHST) = 1 

where NFOV^ = pointer for RFOV offset coordinates table 

i = 1 to 2 

MAXFOV^ = maximum value of pointer NFOV^ i = 1 to 2 
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Step 3 


Send offset pointing coordinates with the break track com- 
mands to the FHST if break track commands are enabled: 

If CMDBKT = 1 Then 

Send break track command to FHST i with 

HRFOV.. = horizontal offset pointing coordinate and 
VRFOV^ j = vertical offset pointing coordinate 
where i = FHST and j = NFOV(FHST) 

F£ S Data Compensation — The FSS data compensation module com- 
pensates FSS data for velocity aberration errors and com- 
putes the FSS measurement residuals, the FSS measurement 
error variances, and the elements of the FSS measurement 
matrix. The input to the FSS data compensation module con- 
sists of the FSS measurements calibrated for the internal 
FSS error sources (i.e., the FSS data after processing by 
the FSS data calibration module). 

The required processing is as follows: 

The total FSS aberration velocity is computed: 

VA = VE + VXS 

where VXS = (VXS^ VXS 2 , VXS 3 ) 

VE = (VE X , VE y/ VE z ) 

The computation is transformed to vehicle coordinations: 

VAV = XFORM(VA, SEPA, -1) 
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The sensor axes are selected: 


If HEAD = 0, 


XF . = 


YF^ 


ZF i 


XFii 


YF li 


ZF li 


i = 1 to 3 
i * 1 to 3 
i = 1 to 3 


Otherwise, 


XFj^ = XF 2i i = 1 to 3 


YF^ = YF 2i i = 1 to 3 


ZF^ = ZF 2i i = 1 to 3 


The aberration corrections are computed: 


EF X = DOT (XF , VAV) * Cl 

EF y = DOT(YF, VAV) * Cl 

EF„ = DOT ( ZF , VAV) * Cl 

z 

where XF = (XF.^ XF 2 , XF 3 ), etc. 

FSS measurements are compensated for aberration: 


XP = XPC - SZN * (EF X - XPC * EF Z ) 

YP = YPC - SZN * (EP y - YPC * EF Z ) 

1/2 

where SZN = (1 + XPC * XPC + YPC * YPC) 

XPC, YPC = saved FSS data (see Table 5-3) 
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The sunline unit vector is computed at the vehicle in ECI 
coordinates : 

~ - 

SA = SIXS - RXS * RSN 

where £lXS = (SIXS X , SIXS Y , SIXS Z ) 

SIXSi = components of Sun-pointing unit vector and 
i = X, Y, Z (from EPHEM) 

RXS = ( RXS i , RXS 2 , RXS 3 ) 

RXSi = saved orbit position data (see Table 5-3) 

RSN = inverse of mean distance from Earth to Sun 
(data base input) 

This computation is transformed to ACAD coordinates: 

SV = XFORM(SA, SEPA, -1) 


where SV is the sunline vector at the vehicle in ACAD body 
axes . 

The expected FSS measurements are computed: 

SP X = DOT(XF, SV) 

SP y = DOT(YF, SV) 

SP Z = DOT ( ZF , SV) 

XPE = SP X /SP Z 
YPE = SPy/SP z 


where 

XPE, 


SPi = expected sunline components along FSS axes 
and i = X, Y, Z 

YPE = expected FSS measurements 
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The measurement residuals are computed: 

Z x = (XP - XPE)/2 
Z 2 = (YP - YPE)/2 

where Z^, Z 2 represent updated sensor measurement residuals. 
The measurement matrix components are computed: 

FM i;l = (XFj^ - ZF ± * XPE)/(SP Z * 2) 

FM 12 = <XF 2 - ZF, * XPE)/(SP Z * 2) 

FM 13 = (XF 3 - ZF 3 * XPE)/(SP Z * 2) 

FM 21 = (YF^ - ZF X * YPE)/(SP Z * 2) 

FM 22 = (YF 2 - ZF 2 * YPE)/(SP Z * 2) 

FM 23 = (YF 3 - ZF 3 * YPE)/(SP Z * 2) 

= CROSS (FM 1# SV) 
lf 2 = CROSS (FM 2 , SV) 

where FM^ = FM i2# FM^ 3 ) = intermediate vectors used in 

computing H , , lT 2 , i = 1, 2 

= measurement vectors (matrix components) for X- 
and Y-measurements (corresponding to i = 1, 2) 


5132 


■ 5-99 



The measurement error variances 


are computed: 


R1 


^1 + XPE 



2 


* RF/4 


* RF/4 

where R 1 = measurement variance for X-measurement 
^2 = measurement variance for Y-measurement 
RF = FSS measurement error variance (DBC) 

g ain Matrix Computation — The gain matrix computation module 
computes the elements of the attitude estimation gain matrix. 
Since the sensor measurements are processed sequentially, the 
gam matrix computation module will be executed twice during 
an attitude estimation processing cycle. The path through 
the gain matrix computation module depends on which measure- 
ment is being processed (i.e., the first or the second). if 
the first measurement is being processed (PASS = 1 for 
X-measurement), set the measurement vector, "h, equal to H* 

(the measurement vector for the first measurement) and 1 
R equal to R 1 . If the second measurement is being proc- 
essed (PASS = 2 for Y-measurement), set IT equal to H and 
R equal to R 2 . 2 

After the proper value of H has been set, the following 
processing is performed: 

f P^l i ] h is computed: 



X 1X = DOT ("H, VP 1 ) 
X 12 = DOT(H, VP 2 ) 
X 13 = DOT (IT, VP 3 ) 
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where 

II 

t — 1 

l£ ‘ 

< M ur 

PM 112' 

PM 113 


<1 

1 

II 


PM 115' 

PM 116 


VP 3 = 


PM 118' 

PM 119 

U = -HI 

:pm ii ] 

H + R is 

computed : 


# 


u = | 

DOT (if. 

where 

II 

< X U- X 12 

CO 
1 — 1 
X 



The first three elements of the gain matrix are computed: 


K. = X. . /U i = 1 to 3 
1 li 

where represents Kalman filter gain matrix elements and 
i = 1 to 6. 

[PM 12 ] H is computed: 

VP 4 ) 

VP 5 ) 

VP 6 ) 

The last three elements of the gain matrix are computed: 

K(i + 3) = X 2i /U i = 1 to 3 

Euler Symmetric Parameter and Gvro Bias Correction Computa- 
tion --The Euler symmetric parameter and gyro bias correction 
computation combines the ATTEST estimates of the Euler sym- 
metric parameter and gyros bias compensation errors into a 


X 21 = DOT (If, 
X 22 = DOT (If, 
X 23 = DOT (it. 


where VP^ = 

(PM 121' 

PM 122 ' 

PM 123> 

vp 5 « 

(PM 124' 

PM 125 / 

PM 126* 

VP 6 - 

(PM 127' 

PM 128' 

PM 129> 
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vector that can be used to update these quantities. The two 
sensor measurements must be processed before the total cor- 
rection vector is computed. A flag, UPDATE, is set to indi- 
cate that update data are available. 

If the first measurement (PASS = 1 for X-measurement) is 

being processed, the error state vector is computed as fol- 
lows : 


SE. = K. * Z x i = 1 to 6 

If the second measurement (PASS = 2 for Y-measurement) is 

being processed, the error state vector is computed as fol 
lows : 


X = DOT(H* 2 , s 1 ) 


Z 


2 



X 


SE. 

l 


SE i + K i * z 2 


i = 1 to 6 


where S 1 is the vector formed from the first three compo- 
nents of SE^ . 

The update ready flag is set after second measurement proc 
essing is complete: 


UPDATE = IENUPD 

G ovgfiaoce Matrix Update — The covariance matrix update mod- 
ule adjusts the elements of the attitude estimation error 
covariance matrix to account for the error reduction achieved 
by processing the update sensor data. The following process- 
ing is performed if IENUPD = 1. Otherwise, no further proc- 
essing in this subsection is performed. 
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The following processing is performed (using data from the 
gain matrix computation module) : 


»iu - PM m - x n * x n /u 


*112 - PM 112 ' X 11 * X 12 /U 


™113 * PM 113 - X 11 * X 13 /U 


PM 114 PM 112 


™115 * PM 115 - X 12 * X 12 /U 


PM 116 ' PM 116 - X 12 * X 13 /U 


*117 * *113 


*118 * *116 


*119 ’ *119 - X 13 * X 13 /U 


The elements of [PM,,] are updated as follows 


*221 ■ ™221 X 21 * X 21 /U 


*222 * *222 - X 21 * X 22 /U 


*223 * *223 * X 21 * X 23 /U 
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PM 224 * PM 222 


PM 225 - PM 225 - X 22 * X 22 /U 


PM 226 PM 226 X 22 * X 23 /0 


PM 227 * PM 223 


PM 228 * PM 226 


PM 229 PM 229 X 23 * X 23 /U 


The elements of [PM^] are updated as follows 


PM 121 * PM 121 - X 11 * X 21 /U 


PM 122 * PM 122 ~ X 12 * X 21 /U 


PM 123 PM 123 X 13 * X 21 /U 


PM 124 = PM 124 - X 11 * X 22 /U 


PM 125 = PM 125 - X 12 * X 22 /U 


PM 126 ~ PM 126 X 13 * X 22 /U 


PM 127 PM 127 X 11 * X 23 /U 
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PM 


128 


= PM 


128 


- X 


12 


* X 23 /U 


PM 129 = PM 129 ' X 13 * X 23 /U 


If the first measurement is being processed, the gain matrix 
computation module is executed again to initiate processing 
of the second measurement. If the second measurement was 
just processed, ATTEST processing is exited. 

• Output — ATTEST produces the following output: 


Name 


Description 


BESi 

CBTi 

FHHASi 

FHMSi 

FHST 

FHTSj 

FHVASi 

FLTINIT 

MDSi 

SEi 

UPDATE 


Save components of Earth's magnetic field vec- 
tor along spacecraft axes where i = X, Y, Z 
(to STARDAT) 

Break track commands to FHST i where i = 1, 2 
(to FHST) 

Save raw FHST horizontal measurements and FHST 
status where i = 1, 2 for FHST 1 or 2 (to 
STARDAT) 

Save FHST intensities from FHST i where i = 1, 

2 (to STARDAT) 

Set FHST selection flag set during attitude 
estimation process to select FHST 1 (FHST = 1) 
or 2 (FHST =2) (to STARDAT, ATTEST) 

Save FHST temperature data from FHST i where 
i = 1, 2 (to STARDAT) 

Save raw FHST vertical measurements and FHST 
status where i = 1, 2 for FHST 1 or 2 (to 
STARDAT) 

Filter initialization flag. This is reset by 
ATTEST (to ATTEST) 

Save components of torquer bar generated dipole 
moment in antenna boom coordinates where i = X, 
Y, Z (to STARDAT) 

Estimate roll, pitch, yaw attitude determina- 
tion errors where i = 1 to 3, and estimated 
roll, pitch, and yaw gyro drift errors where 
i =4 to 6; these errors are in ACAD body axes 
(to KININT) 

Update filter flag (0 = no update, 1 = update) 
(to KININT) 
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5.2.4 ATTITUDE CONTROL 


5. 2. 4.1 High-Level Thrust Control Law Function 

The high-level thrust control law function (HLTCON) uses com- 
manded and actual angular rates and attitude errors to con- 
trol the roll and pitch attitude/rate errors, as shown below. 


• Input — HLTCON uses the following input: 


Name 


Description 


ACS I NT 
BION 

B20N 

DELVKi 

DELVK 2 

DELVT 

DELVTG 

DWi 


D1 X 


D1 y 


D3 X 


D3 Y 

Ei 

HLCNTi 

HKP X 

HKPy 


ACAD sample period (from MODECON) 

Thruster bank 1 (pitch) on flag (0 = off, 1 = 
on) (DBC, set by ground) 

Thruster bank 2 (roll) on flag (0 = off, 1 = on) 
(DBC, set by ground) 

Time bias for OBC thrusting time counter (DBC) 

Time bias for hardware backup timer setting (DBC) 

Velocity control time counter (from HLTCON) 

Commanded thrusting time (DBC set by ground) 

Estimate of rate due to past thruster firing 
where i = 1 to 2 (DBC) 

Roll dead-zone limit for switching on thrusters 
(DBC) 

Pitch dead-zone limit for switching on thrusters 
(DBC) 

Roll dead-zone limit for switching off thrusters 
(DBC) 

Pitch dead-zone limit for switching off thrusters 
(DBC) 

Attitude errors in roll, pitch, i.e., commanded- 
minus-actual angles about the ACAD body axes for 
i = X, Y (variables from ATTERR) 

High-level thruster cumulative counters (from 
HLTCON) 

Roll position gain (DBC) 

Pitch position gain (DBC) 
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Name 


HKR X 

HKRy 

HLTINIT 


IHi 

KIREi 

KREi 

RLli 

RL2i 

RS2i 

RSi 

Wi 

WC X 

WCy 


Description 

Roll rate gain (DBC) 

Pitch rate gain (DBC) 

Flag indicating velocity control parameters are 
to be initialized (= 0, do not initialize, = 1, 
initialize) (variable flag from MODECON, HLTCON) 

Thruster control flag where i = 1 to 2 (from 
HLTCON) 

Integral estimated rate error scale factor where 

1 = 1 to 2 (DBC) 

Estimated rate error scale factor where i = 1 to 

2 (DBC) 

Estimated rate error limit where i = 1 to 2 (DBC) 

Integral estimated rate error limit where i = 1 
to 2 (DBC) 

Integral rate error estimate where i = 1 to 2 
(from HLTCON) 

Rate estimate where i = 1 to 2 (from HLTCON) 

Compensated spacecraft body rates in roll and 
pitch (i = X, Y ACAD body axes) (variables from 
GYRCOMP) 

Commanded spacecraft roll rate about ACAD body 
X-axis (variable from THRUSTR) 

Commanded spacecraft pitch rate about ACAD body 
Y-axis (variable from THRUSTR) 


• Processing — HLTCON is executed every 256 msec dur- 

ing the velocity control mode only. It is performed after 
ATTERR, GYRCOMP, and THRUSTR. 

Initialization — Initialization of this module occurs when 
the velocity control mode is initialized as follows: 


If HLTINIT = 1 


For i 


l 

IH. 

l 

RS2 i 


1 to 2 (roll and pitch axes) 
(rate estimate) 

0 (thruster control flags) 

0 (integral rate error estimate) 
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HLTINIT = 0 

DELVT = DELVTG + DELVK1 
DELVTB = DELVTG + DELVK2 

where IH X , IHy = internal control flags for the roll and 

pitch axes, respectively 

5! hry§tgr CQntr<?l Flags — Each time HLTCON is executed, all 
thruster control flags are set to enable both roll and pitch 
control : 

ICTL^ = l for i = 1 to 4 
If BION = 0 (no pitch control) 

ICTL^ = ICTL 2 = 0 (pitch control orbit adjust 
thrusters (OATs) disabled) 

If B20N = 0 (no roll control) 

ICTL 3 = ICTL 4 = 0 (roll control OATs disabled) 

where JJ TL i = internal flags for indicating high-level 
thruster use for thruster i, where i = 1 to 4 • 

= 0, not used, = 1, used 

C ontrol Law Computation — The high-level thruster control law 
computations are performed for roll and pitch axes (i = l, 

2) if the associated thruster bank is on (B20N = l for roll, 
BION = 1 for pitch). If B20N and/or BION = 0, no control is 
performed about the respective axis and the program skips to 
the Velocity Control Countdown Section. 

For i = l to 2 

If (i = 1 and B20N =1) or (i=2 and BION = l) 
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A rate estimate (RS^) is computed based on the past firing 
history of the high-level thrusters (IH^): 

RS i = RS i + DW i * IH i 

where DWi = estimate of the rate the spacecraft will undergo 
about axis i due to an OAT being off-pulsed (DBC) 

IHi = P ast off-pulsing flag (= 1, positive torque ap- 
plied about axis i; = 0, no torque about axis i; 

= -1, negative torque applied about axis i) 

This estimate is used to compute a (limited) estimated rate 
error (RSl^ ) : 

RSl i = KRE i * (W A - RS^ 

If ABS(RSl i ) > RLl i Then RS^ = SIGI^RS^) * RLl i 

where KRE^ = estimated rate error scale factor about axis i 

RL1 . = estimated rate error limit about axis i 
i 

This estimate is then used to compute a (limited) integral 
rate error (RS2^): 

RS2 i = RS2 i + KIRE i * RS^ 

If ABS(RS2 i ) > RL2 i Then RS2 i = SIGN(RS2 i ) * RL2 i 

where KIRE. = integral estimated rate error scale factor 
RL2^ = integral estimated error limit 

The rate estimate (RS.), estimated rate error (RSl^), and in- 
tegral rate error (RS2^) are then combined to produce an up- 
dated rate estimate: 


RS. 

i 


RS. + RSI. + RS2 . 

ill 
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The rate error (commanded-estimated) is then combined with 
the position error (E^) to give the control law error (ERR.) 

ERR. = HKP. * E. - HKR . * (WC. - RS . ) 

A 1 1 11 1 7 

where HKP^ = position gain 
HKR^ = rate gain 
WC^ = commanded rate 

Control torques are produced by off-modulating the ap- 
propriate high-level thruster. The control torques are 
achieved by sending the appropriate enable/disable command 
to the thrusters. 

Figure 4—13 and Table 4—1 give the OAT locations relative to 
the spacecraft body axes. 

The control law error, ERR^ is processed through a dead- 
band with hysteresis computation as follows for both the 
roll axis (i = 1) and the pitch axis (i = 2). The control 
flags (ICTL i ) are set as follows. 

Case 1: Previous Positive Torque (IH^ = 1) 

If the spacecraft was previously performing a positive torque 
< IHj_ = 1)» the following is performed: If the control law 

error is within the OAT on limit D3 i , the control torque is 
discontinued and the spacecraft’s 0 torque flag is set: 

If ERRi > -D3 . IH. = 0 

i i 

If the control law error is outside the OAT on limit D3 . , 
the appropriate OAT for a positive torque about axis i is 
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off-pulsed. In this case, ERR^ is negative and a positive 
torque was applied to counter a negative pointing error: 

Else (ERR i = < -D3 i ) 

If i = 1 (roll) 

ICTL4 = 0 
Else (pitch) 

ICTL1 = 0 

Case 2: Previous Negative To rque (IH i = -1) 

If the spacecraft was previously performing a negative torque 
(IH. = -1), the following is performed: If the control law 

error is within the on-band D3^ limit, IH^ is set to a 0 
torque. In this case, ERR i is positive and a negative torque 
is needed to counter a positive pointing error: 

If ERR^ < D3 i Then 11^ = 0 

If the control error is outside the on-band limit (D3^), the 
appropriate OAT is offpulsed to perform a torque about 
axis i: 

Else (ERR i > = D3 i ) 

If i = 1 (roll) 

ICTL3 = 0 
Else (pitch) 

ICTL2 = 0 

End if 

Case 3: No Previous Torque (IH.=0) 

If the spacecraft was performing no previous torque (IH^ = 

0), the following is performed: If the control law error 
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(ERR i ) is outside the of f-to-control limit (Dl.), the fol- 
lowing is performed: 1 


If ABS(ERRi) > = Dl. Then 
If ERR i < 0 Then 
IH. = 1 

If i = 1 THEN 
ICTL4 = 0 

Else 

ICTL1 = 0 

End if 

IHj = -1 
If i = 1 Then 
ICTL3 = 0 

Else 

ICTL2 = 0 

End if 

End if 
End if 


Else 


! (a positive torque is needed) 
! (flag for positive torque) 

! (roll) 

! (pitch) 


• ( a negative torque is needed) 
! (flag for negative torque) 

! (roll) 

! (pitch) 


V elocity Control Countdown — The thrusting time counter, DELVT, 
is counted down to zero, at which time shutdown is accomplished 
by disabling all high-level thrusters and requesting a mode 
transition to the thruster maneuver mode by MODECON: 

DELVT = DELVT - AC SI NT 
If DELVT < 0 

ICTL^ =o i = 1 to 4 (disable all OATs) 

ACADMDT = 6 (MODECON request flag to transition to the 
thruster maneuver mode) 
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Output — HLTCON produces the following output: 


Name 


Description 


ACADMDT 


DELVT 

HLCNTi 


HLTINIT 

ICNTLi 

IHi 

RS2i 

RS-i 


ACAD mode request flag to transition to thruster 
maneuver mode (to MODECON) 

OBC thrusting time counter (to HLTCON) 

High-level thruster firing cumulative counters 
where i = 1 to 4 (to HLTCON) 

HLTCON initialization flag (to HLTCON) 

Commands to PE for enabling/disabling high-level 
thrusters where i = 1 to 4 for thrusters 1 to 4 
(to truth model) 

Thruster control flags for axis i where i = 1 
(roll) to 2 (pitch) (to HLTCON) 

Integral rate error estimate where i = 1 (roll) 
to 2 (pitch) (to HLTCON) 

Rate estimate where i = (roll) to 2 (pitch) (to 
HLTCON) 


5. 2. 4. 2 Low-Level Thrust Control Law Function 

The low-level thrust control law function (LLTCON) uses the 
attitude errors and rates to perform a thruster maneuver or 
to maintain attitude control during a velocity correction, 
as shown below. 


Name 

CSLi 

Ei 

KPVi 

KRVi 


Input — LLTCON uses the following input: 

Description 

Count of number of cycles to control (fire) low- 
level thrusters for each axis where i = X, Y, Z 
ACAD body axes (DBCs) 

Attitude errors in roll, pitch, and yaw, i.e., 
commanded-minus-actual angles about ACAD body 
axes where i = X, Y, Z (variables from ATTERR) 

Position gains, velocity control mode for roll, 
pitch, and yaw where i = X, Y, Z ACAD body axes 
(DBCs) 

Rate gains, velocity control mode for roll, 
pitch, and yaw where i = X, Y, Z ACAD body axes 
(DBCs) 
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Name 


Description 


LCAi 

LCBi 

LCCi 

LHi 

LHYi 

LKPi 

LKRi 

LLCNTi 

LLFi 

LLTINIT 

LPLi 

PREli 

PRE2i 

PWFli 

PWF2i 

SSi 

U, V 
w i 
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Rate filter coefficient A where i = 1 to 3 ACAD 
axes (from MODECON) 

Rate filter coefficient B where i = 1 to 3 ACAD 
axes (from MODECON) 

Rate filter coefficient C where i = 1 to 3 ACAD 
axes (from MODECON) 

Past value of hysteresis state flag where i = l 
to 3 ACAD axes (from LLTCON) 

Hysteresis constants for velocity control mode in 
roll, pitch, and yaw where i = X, Y, Z ACAD body 
axes (DBCs) 

Position gains in roll, pitch, and yaw where i = 

X, Y, Z ACAD body axes, thruster maneuver mode 
(DBCs) 

Rate gains in roll, pitch, and yaw where i = x, 

Y, Z ACAD body axes, thruster maneuver mode 
(DBCs) 

Low-level thruster controlled direction and axis 
counter (from LLTCON) 

Axis-controlled flags where i = 1 to 3 (from 
MODECON) 

Low-level thruster initialization flag (from 
MODECON) y v 

Position limits in roll, pitch, and yaw where 

1 Z X ', Y ' 2 ACAD body axes for thruster maneuver 
mode (DBCs) 

Past value of rate error (commanded-actual) where 
l = 1 to 3 ACAD axes (from LLTCON) 

Previous past value of rate error (PREli) where 
i = 1 to 3 ACAD axes (from LLTCON) 

Past value of filtered rate error where i = 1 to 
3 (from LLTCON) 

Previous past value of filtered rate error where 
i = 1 to 3 (from LLTCON) 

Control axis selection parameters where i = 1 to 
3 for axis, i = 4 for transition to new axis 
(from LLTCON) 

Sequential firing logic state parameters (from 
LLTCON) 

Compensated spacecraft body rates in roll, pitch 
and yaw where i = X, Y, Z ACAD body axes (vari- ' 
ables from GYRCOMP ) 
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Name 


Description 


WCi Commanded spacecraft rates in roll, pitch, and 

yaw where i = X, Y, Z ACAD body axes (variables 
from THRUSTR) 

• Processing — LLTCON is executed every 256 msec dur- 

# 

ing the velocity control and thruster maneuver modes. 

Initialization — If the low-level thruster initialization flag 
is set (LLTINIT = 1), the following initialization is per- 
formed : 


LH i = 0 for i = X, Y, Z 
PREl i = PRE2 i » PWFl^ = PWF2 i = - V'L 

for i = X, Y, Z 

SS . = 1 
4 

U = 0 
V = 0 

LLCNT^ = 1 for i = 1 to 6 
LLTINIT = 0 

where LHj = intermediate value of con- 

trol flags CN^, CPi (see 
below) for roll, pitch, and 
yaw where i = X, Y, Z ACAD 
body axes 

PREli, PRE2 i , PWF 1 i , and PWF2i = rate filter state variables 

SS 4 = control axis selection pa- 
rameter 

U, V = sequential logic parameters 

At each pass through LLTCON, the control signals for each 

axis are reset as follows: 


CP i = CN^ = 0 for i = X, Y, Z 


where CPi = control (firing) flags for positive control about 
roll, pitch, and yaw axes where i = X, Y, Z; 

(= 0 , no control, = 1 , control) 
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CN^ = control (firing) flags for negative control about 
roll, pitch, and yaw axes where i = X, Y, Z; 

(= 0, no control, = 1, control) 

i - X, Y, Z ACAD body axes 

C ontrol baw Computation — The axes controlled by the low-level 
thrusters depend on the ACAD mode and the high-level thruster 
bank activated. Control flags LLF: are set in MODECON to in- 
dicate which axes LLTCON controls: If LLF^ = 1, LLTCON con- 

trols axis i and the control law is computed only for these 
axes. The attitude error (E.) is first multiplied by a gain 
(LKP^ and limited to ± LPL^ : 

For i* 1 to 3 

If LLF i = 1 (if control is requested about axis i) 

SP. = LKP . * E. 
i ii 

If ABS(SP i ) > LPI^ Then SP. = sign(SP i ) * LPI^ 

The rate error (commanded - actual) is filtered, and the 
past filter state values are updated. Filter coefficients 
are mode-dependent and set in MODECON: 

WF i = LCC i * (WC t - + 2 * PREl i + PRE2 i ) 

- LCB . * PWF2 . - LCA. * PWF1. 
i i l i 


PRE2 . 

l 

= PRE1 . 

l 

PWF2 . 

l 

= PWF1 . 

l 

PRE1 . 

l 

= wc. - w. 
1 1 

PWF1 . 

l 

= WF. 

l 
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The filtered rate is then added to the position limiter out- 
put to obtain the control law output (S^): 

S i = SP i “ LKR i * WF i 

The control law output (S^ is fed to a deadband plus hys- 
teresis computation that resets the firing flags for positive 
(CP^ or negative (CIT) control. LH^ is the past value of 
the hysteresis state flag and is reset if is outside the 
hysteresis band: 


If ABS(S i ) > = 1 Then LH^ = 1 
If ABS(S i ) < (1.0 - LHY i ) Then = 0 

If [(LH i = 1) and (S^ > 0)] Then 

CN^ = 1 (command negative control about axis i) 

Else 

CN^ = 0 (command no negative control about axis i) 

End if 


If [(LH i = 1) and (S i < 0)] 

CP^ = 1 (command positive control about axis i) 

Else 

CP^ = 0 (command no positive control about axis i) 

Endif 


CP^^ and CN i are the control (firing) flags for positive and 
negative control about the roll, pitch, and yaw axes (i = 1 
to 3) . 

Sequential Loaic/Firina Computations — The multiple firing 
algorithm is shown in Figure 5-10. It allows multiple firing 
about a single axis or a combination of axes. The same axis 
is controlled until variable C is 1 or control is no longer 
desired about that axis (i.e., CP^ or CN^ are 0). C is the 
current firing counter and allows for more than one succes- 
sive firing on each axis. 
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(ENTER) 



▼ 

END 


Figure 5-10. Multiple Firing Algorithm 
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Figure 5-10 provides for all the necessary logic for transi- 
tioning between control axes and firing the thrusters by 
reference to the transition algorithm of the following sub- 
section and to the thruster firing algorithm of Figure 5-11. 

On the first pass through Figure 5-10 after the velocity con- 
trol or thruster maneuver modes are initialized, SS^ is 1, 
so that the transition algorithm will be used to set appro- 
priate values of the control flags (i = X, Y, Z, 4). 

Transition Algorithm — The current thruster firing scheme 
allows control along only one axis at a time. If control is 
reguired about one axis, it is performed about that axis. 

When control is required about two axes, it is alternated 
between the two. If control is required about three axes, 
it is alternated in the order of roll, pitch, and then yaw. 
The state transition algorithm uses information about the 
current controlled axis and the requested axis or axes. The 
algorithm selects only one axis, even if three-axis control 
is desired. 

The state transition algorithm is as follows: (The symbol- 

ogy and explanation of logical operators is shown after 
item 13.) 

1. UP = U 

2. VP = V 

3. R = CP X + CN X 

4. P = CP y + CN y 

5. Y = CP Z + CN Z 

6. U = NOT ( P*Y + UP*VP*R + UP*VP*R + UP*R*Y) 

7. V = P*Y + R*P + UP*VP*R + UP*R + UP*W*Y 

8. SS X = U*V 

9. SS y = U*V 

10. ss z = U*V 

11. SS. = U*V 

4 
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Figure 5-11. Thruster Firing Logic 
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12 . 

13 . 


0 for i = X, Y, Z 
for i = X, Y, Z 


If (SSj^ = 0) , = cr^ = 

If (SS i = 1), C = CSL i 


where C 
CNi 

CPi 

P 

R 


current multiple firing counter 

negative control about roll, pitch, and yaw axes 
where i = X, Y, Z 

positive control about roll, pitch, and yaw axes 
where i = X, Y, Z 

pitch control desired command 

roll control desired command 


Y = yaw control desired command 

SSi = control axis selection parameters where i = X, 

Y, Z (roll, pitch, and yaw axes) (= 0, no con- 
trol; = 1, control) and i = 4 for transition 
(= 0, controlling about any one of the axes; = 1, 
no control on any of the three axes) 

U = sequential logic state parameter 
UP = previous U parameter state 

V = sequential logic state parameter 
VP = previous V parameter state 

+ = logical operator denoting or. Therefore, if 
either CPx or CNx ■ 1, R = 1; otherwise, R = 0 

* = logical operator denoting and; e.g., UP*VP*R is 1 
if each of UP, VP, and R are 1; otherwise, it is 0 

X = denotes complement of X or same as NOT (X) , as 
defined earlier 


The thruster pair firing logic is specified in Figure 5-11 
and is called according to the logic of Figure 5-10. During 
each computation cycle, firing commands will be issued un- 
less the transition parameter SS^ is 1, indicating no con- 
trol is required about any axis. If SS^ = 0, one of six 
firing commands will be issued to the propulsion electronics 
(PE), depending on the control flags SS^ and CP^ for i = X, 

Y, Z. These firing commands (C.LLTP^ and C.LLTN^ for i = X, 
Y, Z) result in low-level thruster firings for positive or 
negative rotations about the X, Y, Z axes. These correspond 
to + roll, ± pitch, or + yaw commands. The following subsec- 
tion, Output, defines these commands. 
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For the current computation cycle time of 256 msec, the above 
commands are issued within 128 msec after the input of the 

last 64-msec gyro data sample used for the current computa- 
tion cycle. 

• Output LLTCON produces the following output: 

— Description 

Commands to PE to fire low-level thrusters for a 
plus rotation about i-axis where i = X, Y, Z for 
roll, pitch, and yaw (to Truth Model) 

Commands to PE to fire low-level thrusters for a 
negative rotation about i— axis where i = x, Y, 

Z for roll, pitch, and yaw (to Truth Model) 

Past value of hysteresis state flag where i = l 
to 3 (to LLTCON) 

Low-level thruster control initialization flag 
reset to zero by LLTCON (to LLTCON) 

Past value of rate error where i = 1 to 3 (to 
LLTCON) v 

Previous past value of rate error where i = l to 
3 (to LLTCON) 

Past value of filtered rate error where i = 1 to 
3 (to LLTCON) 

Control axis selection parameters where i = 1 to 
3 for roll, pitch, and yaw axes; i = 4 for tran- 
sition to a new axis (to LLTCON) 

Sequential logic state parameters (to LLTCON) 

5*2. 4. 3 Thrust er Com mand Processing Function 

The thruster command processing function ( THRUSTR ) computes 
the command rates and command attitudes (Euler symmetric 
parameters) that specify the desired spacecraft attitude and 
rate relative to the ECI frame for the thruster maneuver and 
velocity control modes. Initially, the command attitudes 
are the same as those specified by a ground command, and the 
command rates are set to zero. When the current flight soft- 
ware time (TF17) is greater than a specific value, the com- 
mand rates are set to the values specified by ground control, 
and the command attitudes are turned at the command rates. 


Name 

C.LLTPi 

C . LLTNi 

LHi 

LLTINIT 

PREli 

PRE2i 

PWFlj 

SSi 

U, V 


5132 


5-122 



• Input — THRUSTR uses the following input: 


Name 


Description 


DINITi 
DTCPi 
I TURN 
TCPINIT 
TF 

TSTH 

TTURN 

TTURNS 

WCIi 

WCSi 


Initial attitude command where i = 1 to 4 from 
the GROUND (DBC) 

Updated commanded attitude quaternion where i = 

1 to 4 (from THRUSTR) 

Commanded attitude turning flag (0 = do not 
rotate, 1 = rotate) 

Thruster command processing initialization flag, 
from the GROUND (DBC) 

Current flight software time from the executive 

Sampling period (computation interval) for 
THRUSTR (DBC) 

Time to start turning the command attitude, from 
the GROUND (DBC) 

Saved time to start turning the command attitude 
(from THRUSTR) 

Spacecraft roll, pitch, yaw turning rates where 
i = X, Y, Z ACAD body axes from the GROUND 
(DBCs) 

Saved commanded turning rates where i = 1 to 3 
ACAD axes (from THRUSTR) 


• Processing — The thruster command processing func- 

tion performs the following every 256 msec during the 
thruster maneuver and velocity control modes and before the 
performance of the attitude error computation function. 

It determines if initialization is needed by discerning the 
value of the initialization flag TCPINIT. 


If TCPINIT = 1 


DTCP i = DINIT i for i = 1 to 4 
TCPINIT = 0 


5132 


5-123 


1 


1 to 3 


wcs i = wci i 

TTURNS = TTURN 
I TURN a 0 

where DTCP^ is the updated commanded attitude (Euler param- 
eters) for i = 1 to 4 . 

TTURNS is the saved turning time, and WCS i is the saved 
commanded rate. Otherwise, the above values do not change. 

The turning flag ITURN is set in the following manner: 

If (ITURN = 0) Then ITURN = 1 
Otherwise, ITURN = 0. 

The commanded rates used by THRUSTR are set as follows: 

If (ITURN = 0) Then 

WC i = WCS.^ for i = 1 to 4 

EXIT THRUSTR since the target quaternion does not 
need to be changed 

End if 

If (ITURN = 1) Then 

PROCEED WITH THRUSTR since the target quaternion 
needs to be rotated at the ground command rate 

End if 

One-half the total commanded angular increment is computed as 
follows : 


B = 0.5 * TSTH * 


WCS^ + WCSy + WCS^ 


l 1/2 


where B is one-half the total commanded angular increment. 
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One-half sin (B)/B is computed using an approximation as 
follows : 


S = 0.5 * (1.0 - B 2 /6 + B 4 /120) 


where S represents approximations to sin (B)/B. 
The cosine of B is approximated as follows: 

CB = (1.0 - B 2 /2 + B 4 /24) 


where CB is an approximation to cos B. 

Intermediate parameters C i are computed as follows: 

^ = S * WCS X * TSTH 

C 2 = S * WCS y * TSTH 

C 3 = S * WCS Z * TSTH 

Euler parameter increments are computed as follows: 


DD 1 = C 3 * DTCP 2 - C 2 * DTCP 3 + * DTCP 4 


DD 2 = -C 3 * DTCP 1 + C 1 * DTCP 3 + C 2 * DTCP 4 


DD 3 = C 2 * DTCP 1 - C 1 * DTCP 2 - C c * DTCP 4 


DD 4 = -C 1 * DTCP 1 - C 2 * DTCP 2 - C 3 * DTCP 3 


where DD^ = Euler parameter update increments where i 
to 4 

DTCPi = updated commanded Euler parameters for the 
velocity control mode where i = 1 to 4 
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The commanded Euler parameters 


are updated as follows: 


DTCP. = CB * DTCP. + DD. for i = 1 to 4 

The sign of DTCP.^ is corrected as follows: 

If DTCP. < 0 
4 

DTCP i = -DTCP. for i - 1 to 4 
These parameters are normalized as follows: 

E=0.5*^3- DTCP^ - DTCP^ - DTCP^ - DTCP* j 

DTCP. = E * DTCP i for i = 1 to 4 

Finally, the commanded rates are set equal to the values set 
by the ground: 

WC. = WCSI^ for i = 1 to 3 


Output THRUSTR produces the following output: 


Name 


Description 


DTCPi 
I TURN 
TCPINIT 

TTURNS 


WCn 


WCSi 


Updated command attitude Euler parameters, where 
i - 1 to 4, to attitude error computation function 


Command attitude turning flag (0 
1 = turn) (to THRUSTR) 


do not turn; 


Thruster command processing initialization flag 
THRUSTR) Und ^ thiS iS reset to zero ^ THRUSTR) (to 


Saved time to start turning the command attitude 
(to THRUSTR) 

Commanded spacecraft roll, pitch, and yaw rates, 
where i - X, Y, Z, to low-level thruster control 
law and high-level thruster control law functions 

Saved commanded turning rates where i = 1 to 3 
ACAD axes (to THRUSTR) 
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5. 2. 4. 4 Magnetic Control Law Function 


The magnetic control law function (MAGCON) uses the calcu- 
lated angular momenta and Earth's magnetic field vector to 
compute the commands sent to the magnetic torquer drive elec- 
tronics . 


• Input — MAGCON uses the following input: 


Name 


Description 


BEi 

CALPHAW 

CBETAW 

CENFLAG 

CENT 

CMDMAG 

DCYLMT 

EADTi 

EADT 2 

FAILW 

HWi 

KBTij 


KMD 

KMi 

KMTS 

MAGINIT 


Components of Earth's magnetic field vector 
along ACAD body axes (parameters from MAGPROC) 

Cosine of reaction wheel configuration base 
angle relative to ACAD body coordinates (DBC) 

Cosine of reaction wheel configuration pyramidal 
inclination angle (DBC) 

Control flag for bias momentum loop (DBC) 

Magnetic control law centering scheme constant 
(DBC) 

Flag that determines if MAGCON commands are al- 
lowed (= 0, commands are not allowed; = 1, com- 
mands are allowed) (from MODECON) 

Decay rate for bias momentum loop (DBC) 

Bias momentum decay rate constant (DBC) 

Peak momentum decay rate constant (DBC) 

Failed wheel indicator (DBC) 

Stored angular momentum for reaction wheel i 
where i = 1 to 4 (variables from MOMCOMP) 

Elements of 3 to 3 coordinate transformation 
from ACAD body coordinates where j = X, Y, Z to 
magnetic torquer coordinates where i = X, Y, Z 
(DBCs) 

Maximum magnetic torquer capability constant 
(DBCs) 

Magnetic control law gain where i = X, Y, Z ACAD 
body axes (DBCs) 

Magnetic torquer bar (input data) scale factor 
(DBCs) 

Magnetic control law initialization flag (= 0, 
do not initialize; = 1, initialize) (from 
MODECON and reset to zero by MAGCON) 
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Name 


Description 


SALPHAW 

SBETAW 

XLIM 

XTDEi 

TSML 


Sine of reaction wheel configuration base angle 
relative to ACAD body coordinates (DBCs) 

Sine of reaction wheel configuration pyramidal 
inclination angle (DBC) 

Momentum bias limit (DBC) 

Magnetic torquer bar scale factor where i = X, 
Y, Z, magnetic torquer coordinates (DBCs) 

Sampling period (computation interval) for mag- 
netic control law (DBC) 


• Processing — MAGCON is executed every 512 msec during 

normal pointing mode and standby mode (commands not sent) . 


Initialization — The following initialization is performed if 
MAGINIT = 1. Otherwise, this section is skipped. 


PEAKP i = 0 
PEAKN i = 0 
HCENT i = 0 
COUNTER . = 0 
MAGINIT = 0 

where PEAKPi = component i of positive momentum peak 

where i = X, Y, Z 

PEAKNi = component i of negative momentum peak 
where i = X, Y, Z 

HCENTi = momentum bias vector component in ACAD body 
axes where i = X, Y, Z 

COUNTERi = counter for i axis momentum loop delay 
where i = X, Y, Z 

The failed wheel flag (FAILW) is first examined, and the 
momentum input associated with a failed wheel is set to zero. 
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The momentum is first copied to a temporary variable as 
follows : 


THW^ = HVT for i = 1 through 4 

IF FAILW = 0, no adjustment occurs. 

Otherwise, 


THWj = 0 for j = FAILW 

NOTE : This algorithm may be modified to include additional 

failure options. 

Body Momentum Computation — The reaction wheel momenta from 
each wheel are combined and transformed into ACAD body coor- 
dinate components: 

H x = (im i + THW 2 + THW 3 + THW 4 ) * CBETAW 

Hy = [(THW 4 - THW 1 ) * CALPHAW + (THW 2 - THW 3 ) 

* SALPHAW] * SBETAW 

H z = [(THW 1 - THW 4 ) * SALPHAW + (THW 2 - THW 3 ) 

* CALPHAW] * SBETAW 

where H^ represents reaction wheel momentum components in 
ACAD body coordinates for i = X, Y, Z. 

Peak Momentum Bias Computation — Momentum bias vector compo- 
nents (HCENT. for i = X, Y, Z) are calculated to center the 
angular momentum accumulation about each ACAD body axis. In 
this calculation, positive and negative momentum peaks are 
first identified and decayed exponentially. When an instan- 
taneous momentum component exceeds the positive or negative 
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peak, it becomes the new peak. This is accomplished as fol- 
lows for i = X, Y, z .(ACAD body axes): 

If > PEAKP^ counter i = counter i + l 

PEAKP. = H. 
l l 

where PEAKP^ = component i of positive momentum peak 

and if H. < PEAKN. 

i x 


PEAKN. = H. 
l l 

where PEAKN ^ = component i of negative momentum peak 
Peak Momentum Bias Decay 

If COUNTER . > DCYLMT 

PEAKP . = PEAKP A * EADT2 
PEAKN . = PEAKN i * EADT2 
HCENT i = HCENT i * EADT1 
COUNTER. = 0 

l 

The bias vector is then computed from its previous value and 
a constant times the sum of the positive and negative momen- 
tum peaks, as follows: 

HCENT. = HCENT. + TSML * CENT * (PEAKP. + PEAKN.) * DCYLMT 

Finally, the momentum bias vector components are limited as 
follows (for each i): 

If | HCENT ^ | > XLIM 

HCENT^ = XLIM * sign ( HCENT ^ ) 

Otherwise, there is no change in HCENT^ . 

where HCENTi = momentum bias vector components in ACAD body 

axes where i = X, Y, z 


5132 


5-130 



TSML = MAGCON sampling period (512 msec) 

DCYLMT = decay rate for momentum bias loop 

CENT = magnetic control law centering constant 

Dumped Momentum Computation — The momentum that the magnetic 
control law attempts to "dump" is computed based on the 
value of the momentum bias flag (CENFLAG) . If CENFLAG is 0, 
the momentum bias is ignored and the momentum to be dumped 
is simply the sensed reaction wheel momentum in body coordi- 
nates. If CENFLAG is 1, the momentum to be dumped is the 
vector sum of the sensed reaction wheel momentum and the 
momentum bias in body coordinates. This is accomplished as 
follows : 

If CENFLAG = 1 

HD i = (Hj + HCENT i ) * (1.35582) for i = X, Y, Z 
Otherwise (CENFLAG / 1) 

HD i = H i * (1.35582) for i = X, Y, Z 

where HDi = instantaneous momentum components to be zeroed by 
the magnetic control law 

The 1.35582 term is used to convert angular momentum from 
foot-pound-seconds to newton-meter-seconds. 

Torouer Bars Magnetic Moment Computation — The cross-product 
vector between the Earth's magnetic field vector and the 
momentum vector to be dumped is computed as 

M = B X HD 


where M = (Mx< My/ Mg) = cross-product vector of Earth's 
magnetic field vector and momentum vector to be 
dumped in newton-meter-seconds-gauss 

l3 = (BEx, BEy, BE2) = Earth's magnetic field measured 
by the magnetometers in gauss 

HD = (HDx/ HDy , HDg) = excess momentum to be dumped 
in newton-meter-seconds 
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The commanded magnetic moment vector components are defined 
as 

M i = -KM i * M i i = X, Y, Z 

where KM^ = magnetic control low gain; units; 
1/second-gauss-tesia 

Mi = commanded magnetic moment components in ACAD body 
ACAD body axes for i - X, Y, z, in ampere-meters^ 

This vector is transformed into magnetic torquer coordinates 
as follows: 

'«TORQ x l r KBTxx kb Txy kbt xz 1 

MTORQ y = KB Tyx KBTyY KBT YZ My 

_MT°R Q Z _ KBT 2X KBT zy KBT zz M z 

where MTORQy are the commanded magnetic moment components 
in magnetic torquer coordinates in ampere-meters 2 . 

The commands are converted to counts, which become the com- 
mands sent to the magnetic torquers as follows: 

MTORC^ = Rnd(MTORQ i * XTDE^ for i - X, Y, Z 

where RND(A) = sign of A times the largest integer < ABS (A + 

(0.5) * sign(A)) 

These commands are limited as follows: 

If |MTORQ. | > KMD 

MTORQ i = KMD * sign (MTORQ.) for i = X, Y, Z 
Otherwise, there is no change in MTORQy for i = X, Y, Z. 
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The torquer bar commands are then converted from counts to 
2 

ampere-meters so they can be shipped to the Truth Model: 


C.MLi = MTORQi/XTDEi for i = X, Y, Z magnetic torquer 

axis 


If CMDMAG = 1, the commands are sent to the torquer bars. 


If CMDMAG ^ 1, the commands are not sent to the torquer bars. 


• Output — MAGCON produces the following output: 


Name 


Description 


C.MLi Commanded magnetic moment components in counts 

sent to the TDE each computation cycle where i = 

X, Y, Z magnetic torquer axes (to Truth Model) 

MAGINIT Magnetic control law (MAGCON) initialization flag; 
reset to zero by MAGCON (to MAGCON) 


5. 2. 4. 5 Wheel Control and Distribution Function 


The wheel control and distribution function (WHECON) com- 
putes reaction wheel torque commands required to maneuver, 
maintain spacecraft attitude, and distribute momentum among 
the wheels during the normal maneuver and pointing modes as 
shown below. It uses attitude error, gyro data compensa- 
tion, and stored momentum data in performing these computa- 
tions . 


Name 


Input — WHECON uses the following input: 
Description 


ACSINT Sampling period (computation interval) for 

WHECON (from MODECON) 

DWi j k Elements for transforming requested torques in 

ACAD body axes to reaction wheel torque com- 
mands where i = 0 to 4 (i= FAILW) , j = 1 to 4 
(wheel), and k = 1 to 3 (ACAD body axes) (DBCs) 

Ef Attitude errors in roll, pitch, and yaw, i.e., 

commanded-minus-actual angles about the ACAD 
body axes where i = X, Y, Z (variables from 
ATTERR) 
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Name 


ELOi 

ETHRESH 

FAILW 

HBIAS 

HWj 

IELi 

KD 

KWCi 

PEEi 

PHWSi 

PIEi 

PTWj 

TEXi 

TEli 

TE2i 

TFli 

TF2i 

TLi 

TRWINT 

VELi 


Description 

Default angular error limits where i = X, Y, Z 
ACAD body axes (DBCs) 

Threshold for default angular error limits 
(DBCs) 

Failed wheel indicator (= 0, no wheel failed; 

= i/ wheel i failed where i = 1 to 4) (DBC/GND) 

Momentum distribution bias (DBC) 

Stored angular momentum for reaction wheel i 
where i = 1 to 4 (variables from MOMCOMP) 

Integral error limits for roll, pitch, and yaw 
where i = X, Y, Z ACAD body axes (DBCs) 

Momentum distribution time constant (DBC) 

Reaction wheel torque command scale factors 
where i = 1 to 4 (DBCs) 

Past value of wheel momentum estimate where i = 

1 to 4 (from WHECON) 

Past value of wheel momentum estimate where i = 

1 to 4 (from WHECON) 

Past value of limited integral error where i = l 
to 3 (from WHECON) 

Past value of wheel torque commands where i = l 
to 4 (from WHECON) 

Reaction wheel friction estimate for wheel i 
where i = 1 to 4 (DBC) 

Torque filter state 1 where i = 1 to 3 (from 
WHECON) 

Torque filter state 2 where i = 1 to 3 (from 
WHECON) 

Filtered torque state 1 where i ■ 1 to 3 (from 
WHECON) 

Filtered torque state 2 where i = 1 to 3 (from 
WHECON) 

Torque limit in roll, pitch, and yaw where i = 

X, Y, Z ACAD body axes (DBCs) 

Time interval for updating estimated wheel 
momentum (DBC) 

Variable error limit constants, where i = X, Y, 

Z (DBC) 
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Name 


W-; 


WCAi 

WCAli 

WCA2i 

WCBli 

WCB2i 

WHEINIT 

WKIi 

WKPi 

WKRi 

WLi 

WTLi 


Description 

Compensated spacecraft body rates in roll, 
pitch, and yaw where i = X, Y, Z body axes 
(variable from GYRCOMP) 

Filter constant A where i = 1 to 3 (DBC) 

Filter constant A1 where i = 1 to 3 (DBC) 

Filter constant A2 where i = 1 to 3 (DBC) 

Filter constant B1 where i = 1 to 3 (DBC) 

Filter constant B2 where i = 1 to 3 (DBC) 

WHECON initialization flag; = 0, no; = 1, yes 
(from MODECON, WHECON) 

Wheel control law integral gain where i = 1 to 3 
ACAD axes (DBC) 

Wheel control law proportional gain where i = 1 
to 3 ACAD axes (DBC) 

Wheel control law rate gain where i = 1 to 3 
ACAD axes (DBC) 

ACAD body axes rate limits where i = X, Y, Z 
ACAD body axes (roll, pitch, yaw) (DBCs) 

Wheel torque limits where i = 1 to 4 for 
wheels 1 to 4 (DBCs) 


• Processing — WHECON is executed every 512 msec dur- 

ing the normal pointing and normal maneuver modes. It is 
performed after ATTERR and MOMCOMP. 

Initialization — If WHEINIT = 1, the following initialization 
is performed: 


PIE^ = 0 for i = 1 to 3 (past integral error) 

WOI^ = 1 for i = 1 to 4 (wheel health status flag) 

PHWS . = HW. for i = 1 to 4 
l i 

PTW^ = TRW^ = 0 for i = 1 to 4 
ICNT = TRWINIT/ACSINT 
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Variable Error Limits — Angular error limits for roll, pitch, 
and yaw are calculated as follows: 

> 

EMAG = (E x * E x + E y * + E z * E z ) 1/2 

where EMAG is the magnitude of the total angular position 
error . 

If EMAG > ETHRESH, 

EL i = I | * VEL./EMAG for i = X, Y, Z 

where EL^ = variable error limits for i = x, Y, Z 
i = X, Y, Z ACAD body axes 
Otherwise, 


EL^ « ELO^ for i = X, Y, Z 

where ELO i are the default values. 

• C ontrol Law — The following is a proportional plus 
integral plus derivative control scheme that calculates 
torque commands along the ACAD body axes. EE., WW. , and IE. 
are local variables, and PEE. and PIE. are the past values 1 
of EE. and IE., respectively. The control law error output 
(TE^) is filtered and limited for i = x, y, Z. 

If ELj < lEjl, 

EEj - EL^ * sign (E.) 

where EEi = limited angular errors in roll, pitch, and 

for i = x, Y, Z ACAD body axes 

sign (a) = 1 if a > 0, sign (a) = -1, if a < 0 
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Otherwise 


EE . = E . 

l l 


IF WHENINIT = 1 


Then PEE. = EE. 

l l 

where PEE^ is the past value of the limited angular errors 
(see below) . 

The ACAD body rates in roll, pitch, and yaw are limited by 
performing the following successively for i = X, Y, Z: 

If WL. < |w. I 
i 1 i 1 


WW^ = WL^ * sign (W^) 

where VTOT represents limited body axes rates and i = X, Y, 
Z for roll, pitch, and yaw. 

Otherwise, 


VW*i = W. for i = X, Y, Z 


The integral error in roll, pitch, and yaw is computed as 


IE i = PIE i + ACSINT * (EE i + PEE^/2 for i = X, Y, Z 


where IE^ = integral error in roll, pitch, and yaw 

PIEi = P ast value of integral error in roll, pitch, a 
yaw (see below) 

PEEi = past value of limited angular error in roll, 
pitch, and yaw (see below) 

i = X, Y, Z ACAD body axes 
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The integral errors are limited by performing the following 
successively for i = X, Y, Z: 

If | IE i | > IEI^ 


IE. 

X 

= I EL . 

l 

* sign ( IE^ ) 

i is no 

change 

in 1^ . 

are updated as 

follows: 

PEE. = 

l 

EE i 

for i = X, Y 

PIE. = 

l 

IE. 

l 

for i = X, Y 


The control law error output is computed as follows 


TE t = WKP i * EE i + * IE.^ - WKJ^ * WVT for i = X, Y, 


where TE^ are requested torques about the X, Y, Z ACAD body 
axes (roll, pitch, yaw). 

If WHECON is being initialized (WHEINIT = 1), the following 
is performed: 


TF2 i = TF1. = TE2 i = TEl i = TE ± for i = X, Y, Z 

where TEl^ = torque filter state 1 
TE2^ = torque filter state 2 
TFl^ = filtered torque state 1 
TF2 ^ = filtered torque state 2 

TFK^ is limited as follows: 

If ABS(TFK i ) > TI^ 

Then TFK i = TL^ * sign(TFK i ) for K = 1, 2 
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Otherwise, TFK^ is not changed. 

The filter control law error (TF^ ) is then computed in ACAD 
coordinates : 

TF. = WCA. * TE. + WCA1 . * TE1 . + WCA2 . * TE2 . 
ill ll 11 

- WCBl i * TFl^ - WCB2 i * TF2^ 

where WCA, WCA1,. WCA2 , WCB1, and WCB2 are the filter con- 
stants . 

The filter control law error is then limited as follows: 

If ABS(TF i ) > TL t 

TF. = TL. * SIGN(TF. ) 

ll l 

Otherwise, TF^ remains unchanged. 

The torque states are then saved for the next iteration: 

TF2 . = TF1 . 

l l 

TFl^ = TF^ 

TE2 . = TE1 • 

l l 

TE1 . = TE. 

l l 

The WHECON initialization flag is then set to zero: 

WHEINIT = 0 

Otherwise, there is no change in T^ . 

• Steering Law. Momentum Distribution, and Command 
Output — The steering law computes the torques for each 


5132 


5-139 


reaction wheel as a function of which wheel (if any) is 
disabled. The torque for each axis is computed as follows: 






— 

1 

TW X 


Dw ill 

DW il2 

DW il3 



tw 2 


DW i21 

DW i22 

DW i23 


TF 

X 

tw 3 


DW i31 

DW i32 

DW i33 


TF 

Y 

tw 4 


DW i41 

DW i42 

DW i43 


TF Z 

- 


- 





where TW. = torque for wheel j , j = 1 to 4 

i = FAILW = failed wheel indicator where i = 0 for no 
failure, i = 1 to 4 for wheel 1 to 4 failure 

Momentum distribution is accomplished as follows: 

If FAILW = 0, the momentum distribution law is implemented: 

HDIS = [1/4 * (HW^ - HW 2 - HW 3 + HW 4 ) - HBIAS] * KD 


TW X 

= TW X 

- HDIS 

tw 2 

= tw 2 

+ HDIS 

tw 3 

= TW 3 

+ HDIS 

tw 4 

= TW. 
4 

- HDIS 


where TW^ represents torque commands to wheels 1 to 4, j = 

1 to 4 . 

Otherwise (FAILW / 0), and no momentum distribution computa- 
tions are made. 

The wheel torques, TW^ are then limited as follows: 

If ABS(TW i ) > WTL t for i = 1 to 4 
Then TW i = WTL^ * SIGN(TW i ) 
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Otherwise, TVT remains unchanged. 

An estimate for wheel friction is then added: 

TCONL = TVT + TEX^ * SIGNCHW.^ for i = 1 to 4 

The torque command is rounded down to an integer value. If 
a particular wheel has been identified as failed, the torque 
command for that particular wheel is set to 0: 

For i = 1 to 4 

If i ^ FAILW Then 

C.WCT i = RND (TCOM i * KWC^) 

Else 

C.WCT i = 0 

End if 

The wheel torque commands, C.Wd^, are formed from TVK for 
i = 1 to 4 and are output to the Truth Model each computa- 
tional cycle: 

C.WCT i = C.WCT i /KWC i 

Wheel Failure Detection — Wheel failures are determined by 
comparing the estimated wheel momentum based on integration 
of the reaction wheel torque commands (HWS^) with the meas- 
ured momentum (HW^ from MOMCOMP. If the difference ex- 
ceeds the error threshold, HWET, the health status flag, 

WOK^ , is set off: 

For i = .1 to 4 

HWS i = PHWS^ + ACSINT * (TW i + PTW^/2.0 
PWS^^ = HWS i 

PTW. = TW. 

l l 

If ABS(HW. - HWS . ) > HWET and CMDWHE = 1 Then WOK. = 0 
'll i 
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At the end of each TRWINT computation period, the estimated 
wheel momentum is reset to the actual momentum, HW. 


ICNT = ICNT - 1 

IF ICNT < = 0 Then 

ICNT = TRWINT/ACSINT 

For i = 1 to 4 

PHWS . = HW. 
l l 

Enddo 

End if 


Name 
C . WCTi 

ICNT 

PEEj 

PHWSi 

PIEi 

PTWi 

TEli 

TE2i 

TFlj 

TF2i 

WHEINIT 

WOKi 


t P V t WHECON produces the following output i 

Description 

Torque commands to wheels 1 to 4 where i = 1 to 
4 (ft-lbf) (to Truth Model) 

Momentum update time counter (to WHECON) 

Past value of limited error where i = 1 to 3 (to 
WHECON) V 

Past value of estimated wheel momentum where i = 

1 to 4 (to WHECON) 

Past value of limited integral error where i = l 
to 3 (to WHECON) 

Past value of torque command to wheel where i = l 
to 4 (to WHECON) 

Torque filter state 1 where i = 1 to 3 (to 
WHECON) v 

Torque filter state 2 where i = 1 to 3 (to 
WHECON) v 

Filtered torque state 1 where i = 1 to 3 (to 
WHECON) V 

Filtered torque state 2 where i = 1 to 3 (to 
WHECON) v 

WHECON initialization flag (to WHECON) 

Wheel health status flag where i = 1 to 4; = o 
bad; = 1, good (to SAFECON) 
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5. 2. 4. 6 Mode Control Function 

The mode control function (MODECON) controls the transitions 
between the various modes of operation of the ACAD subsys- 
tem. Input consists of the mode transition request from the 
ground and from the SAFECON, HLTCON , and MODECON software 
functions . 

MODECON examines the various requests in priority order and 
transitions to the new mode if the requested transition is 
valid. MODECON also implements the test for Sun acquisition 
in the Sun reference pointing mode (SRPM) . If the test 
fails, MODECON requests itself to make the transition to the 
safe hold mode (SHM) . 

The ACAD modes of operation controlled by the OBC are de- 
fined as follows: 


ACAD Mode 
Number 

1 

2 

3 

4* 

5* 

6 

7 


Definition 

Standby mode (SM) 

Normal pointing mode (NPM) 

Normal maneuver mode (NMM) 

Sun reference pointing mode (SRPM) 
Safe-hold mode (SHM) 

Thruster maneuver mode (TMM) 
Velocity control mode (VCM) 


The asterisks (*) indicate modes that are not controlled by 
the OBC but by the control processing electronics (CPE) firm- 
ware. Upon transition to a CPE-controlled mode from an OBC- 
controlled mode, the OBC informs the CPE which actuators are 
in use and the status of the gyro and gyro channels. 

Figures 5-12 through 5-16 describe the processes for each of 
the above OBC— controlled modes. Table 5—5 lists the various 
module processing times, and Table 5-6 lists the initial 
MODECON variables for each OBC mode. 
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Figure 5 12. ACAD Mode 1: Standby Mode 
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Figure 5-13. ACAD Mode 2: Normal Pointing Mode 
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Figure 5-15. ACAD Mode 6: Thruster Maneuver Mode 
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Figure 5 16. ACAD Mode 7: Velocity Control Mode 
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Table 5-5. Functions Executed by ACAD Mode, Frequency 


Mode Number 
Mnrie Name 

1 

SM 

2 

NPM 

3 

NMM 

4 

SRPM 

0 

SHM 

o 

TMM 

/ 

VCM 

Function 








MODECON 

0.256 

0.256 

0.256 

0.256 

0.256 

0.256 

0.256 

GYRODAT 

0.256 

0.256 

0.256 

0.256 

0.256 

0.256 

0.256 

FSSPROC 

32.768 

32.768 


32.768 

32.768 


* 

MAGPROC 

0.512 

0.512 


0.512 

0.512 



MOMCOMP 

0.256 

0.256 

0.256 

0.256 

0.256 

0.256 

0.256 

STARAVG 

0.256 

0.256 


0.256 

0.256 



KININT 

0.512 

0.512 

0.512 

0.512 

0.512 

0.256 

0.256 

(1) EPHEM 

2.048 

2.048 

2.048 

2.048 

2.048 

2.048 

2.048 

ORIENT 

2.048 

2.048 

2.048 

2.048 

2.048 

2.048 

2.048 

OCCULT 

2.048 

2.048 

2.048 

2.048 

2.048 

2.048 

2.048 

ATTEST 

32.768 

32.768 


32.768 

32.768 



STARDAT 

32.768 

32.768 


32.768 

32.768 



THRUSTR 






0.256 

0.256 

ATTERR 

0.512 

0.512 

0.512 

0.512 

0.512 

0.256 

0.256 

HLTCON 







0.256 

LLTCON 






0.256 

0.256 

MAGCON 

0.512 

0.512 


0.512 

0.512 



(2) ANTCON 

0.128 

0.128 

0.128 

0 . 128 

0.128 

0.128 

0 . 128 

WHECON 

0.512 

0.512 

0.512 

0.512 

0.512 



( 3 ) SAFECON 


0.512 

0.512 

65.536 

65.536 

0.256 

0 . 256 


NOTES : 


1. EPHEM also has long period processors that execute 
every 1200.128 sec (about 20 min) in all modes. 

2. ANTCON initialization, TDRS selection, and gimbal 
angle generation functions are executed every 
0.512 sec in all modes. 

3. ACAD monitor functions of SAFECON are performed every 
0.512 sec in modes 2 and 3 and every 0.256 sec in 
modes 6 and 7 . 

4. This table reflects dependencies spelled out in some 
of the processing sections of various modules (e.g., 
ANTCON is executed after ATTERR and before WHECON) . 
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Table 5—6 . 

ACAD 

Flags and 

Constants Set 

on Mode 

Initiation 


(1 Of 

2) 






Mode Number 

1 

2 

3 

4 

5 

6 

7 

Mode Name 

£M 

NPM 

NMM 

SRPM 

SHM 

u 

TMM 

/ 

VCM 

GYRINIT 

1 

0 

0 

0 

0 

0 

0 

FLTINIT 

1 

1 

0 

1 

1 

0 

0 

MAGINIT 

1 

1 

0 

1 

1 

0 

0 

WHEINIT 

1 

1 

1 

1 

1 

0 

0 

ANTINIT 

1 

1 

0 

0 

0 

0 

0 

LLTINIT 

0 

0 

0 

0 

0 

1 

1 

HLTINIT 

0 

0 

0 

0 

0 

0 

1 

SCMINIT 

1 

0 

0 

0 

0 

0 

0 

MOMINIT 

1 

0 

0 

0 

0 

0 

0 

CMDANT 

0 

1 

0 

0 

0 

0 

0 

CMDWHE 

0 

1 

1 

0 

0 

0 

0 

CMDMAG 

0 

1 

0 

0 

0 

0 

0 

CMDBKT 

0 

1 

0 

0 

0 

0 

0 

ACADMD 

1 

2 

3 

4 

5 

6 

7 

ACS I NT 

512 

512 

512 

512 

512 

256 

256 

LLF. 








l 






1 

1 

ISTCNT . 

3 

0 

0 


0 

0 



STRAVG . 
3 

0 

0 


0 

0 



TFSCAN . 

3 




1 

1 



AECT 


1 

2 



3 

4 

ARCT 


1 

2 



3 

4 

GCCT 


1 

2 

3 

4 

5 

6 

SGCL 


1 

2 

3 

4 

5 

6 

TGCL 


1 

2 

3 

4 

5 

6 

THGCL 


1 

2 

3 

4 

5 

6 

LIMKEY 

1 

2 

3 

4 

5 

6 
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Table 5-6. 

ACAD 

Flags and 

Constants Set 

on Mode Initiation 


(2 of 

2) 




Mode Number 

1 

2 

3 

4 

5 6 7 

Mode Name 

SM 

NPM 

NMM 

SRPM 

SHM TMM VCM 


LCA . 

l 

LCB. ^ 

LCC. 
1 

LKP. 

l 

LKR . 

l 

LPL . 

l 

LHY . 

l 


1 

1 

1 

1 

1 

1 

1 


2 

2 

2 

2 

2 

2 

2 


NOTES : 1. ACSINT is in units of milliseconds. 

2. The numbers given for AECT through LHYi are the 
values of j to use in setting these constants 
from the corresponding data base values AECTj 
through LHYi j , respectively. 
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• Input — MODECON uses the following input: 


Name 


Description 


ACADMD 

ACADMDA 

ACADMDG 

ACADMD S 

ACADMDT 

ACS I NT 

AECTj 

AQTAK 

AQTAL 

AQTBK 

AQTBL 

ARCTj 

BION 

B20N 


DW i,j,k 

FAILW 

GCCTj 

IGYi 

LCA i# j 

LCB i/;j 

LCC itj 


Current ACAD mode (from MODECON) 

Request for mode transition (from MODECON) 

Request for mode transition (from DBC/GND , MODECON) 
Request for mode transition (from SAFECON, MODECON) 
Request for mode transition (from HLTCON, MODECON) 
ACS sample period (from MODECON) 

Attitude error comparison thresholds where i = 1 to 
6 (DBCs ) J 


Sun acquisition time counter A (from MODECON) 

Sun acquisition time limit A (DBC) 

Sun acquisition time counter B (from MODECON) 

Sun acquisition time limit B (DBC) 

Attitude rate comparison thresholds where i = 1 to 
6 (DBCs) 


High-level thruster bank 1 (pitch) on-flag; = 0, 
off} = 1/ on (DBC set by the ground) 

High-level thruster bank 2 (roll) on-flag; = 0, 
off; = l, on (DBC set by the ground) 

Coordinate transformation from ACAD axes (where i = 
1 to 3) to reaction wheel axes (where i = 1 to 4 
k = FAILW = 0 to 4 DBC) 

Failed reaction wheel flag (DBC reset by ground and 


Gyro channel comparison thresholds where i 
(DBCs) J 


1 to 6 


Gyro channel selection flags where i = 1 to 3 (DBC 
reset by ground and SAFECON) 

LLTCON rate filter constant A where i = 1 to 3 ACAD 
axes; j = 1 to 2 for TMM, VCM (DBC) 

LLTCON rate filter constant B where i = 1 to 3 ACAD 
axes; j = 1 to 2 for TMM, VCM (DBC) 

LLTCON rate filter constant C where i = 1 to 3 ACAD 
axes; j = 1 to 2 for TMM, VCM (DBC) 
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Name 


Description 


LHYi,j 

LIMKEYj 

LKPi,j 

LKRi,j 

LPL i,j 

MODEX 

RECREQ 

SBTIMEK 

SBTIMEL 

SGCLj 

SYNCK 

SYNCTM 

SUNPRS 

TGCLj 

THGCLj 


LLTCON hysteresis constants where i » 1 to 3; j =1 
to 2 (DBCs) 

ANTCON keyhole where j = 1 to 6 (DBC) 

LLTCON position gains where i = 1 to 3; j = 1 to 2 
(DBCs) 

LLTCON rate gains where i ■ 1 to 3; j = 1 to 2 
(DBCs) 

LLTCON position error limits where i = 1 to 3 ; j = 

1 to 2 (DBCs) 

Mode transition control flag (from MODECON) 

Request for reconfiguration of ACAD hardware (from 
SAFECON) 

Standby mode time counter 

Time unit for standby mode (DBC) 

Single-axis gyro compare limits where j = 1 to 6 
(DBCs) 

ACAD hardware resynchronization time counter (from 
MODECON) 

ACAD hardware synchronization time (DBC) 

Sun present flag (from FSSPROC) 

Two-axis gyro compare limits where j = 1 to 6 
(DBCs) 

Three gyro compare limits where j = 1 to 6 (DBCs) 


• Processing — MODECON is performed every 256 msec in 

all modes. 


Initialization 

ACADMD = 0 
ACADMDG = 0 
ACADMDT = 0 
ACADMDS = 0 
RECREQ = 0 
MODEX = 0 
ACADMDA = 1 
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Mode Transition Validi ty Test — Ground-requested mode transi- 
tions are performed only when the requested mode is different 
from the current mode, precluding reinitializations in the 
ACS software functions without an explicit mode change. The 
allowable mode transitions are shown in Table 5-7. 

Concurrent mode transition requests are executed in the fol- 
lowing priority order: 

1. ACADMDG > 0 Ground request 

2. ACADMDA > 0 MODECON request 

3. ACADMDS > 0 SAFECON request 

4. ACADMDT > 0 HLTCON request 

if more than one request is pending, only the highest pri- 
ority is honored. (Lower priority pending requests are can- 
celed.) If a valid transition is requested, the MODEXIN and 
MODEX flags are set to control mode initiation and mode 
transition as described in Table 5-7 and the safe contin- 
gency mode transition processing. Invalid requests and can- 
celed requests are telemetered to the ground. 

The processing in this section is performed only if MODEX = 0 
(i.e., no mode transition is currently in progress). 

If MODEX = 0 

If the ground commands the spacecraft to transition to 
another mode, this portion of the code is used: 

Then if (ACADMDG = (1-6) and ACADMD = (1-6) and 
ACADMDG < > ACADMD or 

ACADMDG = (1, 5, or 6) and ACADMD = 7 or 
ACADMDG = 7 and ACADMD =6) 

Then MODEX = ACADMDG 


5132 


5-154 



Table 5-7. ACAD Mode Transition Matrix 


1 


2 3 4 


5 6 


7 


SBM 

G,S 

G 

G 

G 

G 


G 

NPM 

G 

G,S 

G,S 

G 


G 

G 

NMM 

G,S 

G,S 

G 


G 

G 

G 

SRPM 

G.A 

G 


G 

G 

G 

G 

SHM 

G 


G 

G 

G 

G 

G.S 

TMM 

G 

G 




G.S 

G.T 

VCM 


NOTES: 1 . G = Ground command 

S = SAFECON request 
T = HLTCON request 
A = MODECON request 

2. The ACAD modes are shown on the diagonal matrix elements and allowable 
transactions are indicated by and entry in the off-diagonal matrix element 
connecting the two modes in question. Blank off-diagonal elements indicate 
unallowable transitions. Transitions take place clockwise. 


3. Hardware configurations are not shown, since the mode definition does not 
depend on configuration. 

4. The initial transition to SBM at OFS initialization is not shown. 
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If MODECON is commanding a mode transition, this portion of 
the code is used: 

Else if (ACADMDA = 1 and ACADMD = 0 or 
ACADMDA = 5 and ACADMD =4) 

Then MODEX = ACADMDA 

If SAFECON is commanding a transition to either SRPM or SHM, 
the following code is used: 


Else if (ACADMDS = 4 and ACADMD = (2 or 3) or 

ACADMDS = 5 and ACADMD = (2, 3, 6, or 7)) 

Then MODEX = ACADMDS 

If the spacecraft is in the VCM and the mode is finished, 

the transition to the TMM is performed in this portion of 
the code: 

Else if (ACADMDT = 6 and ACADMD = 7) 

Then MODEX = ACADMDT 
End if ! (MODEX = 0) 

If a mode transition is in progress already, this code is 
used: 

If MODEX * o 

Then MODEXIN = 1, PREVMODE = ACADMD 
Else 

MODEXIN = 0 

End if 

ACADMDG = 0 
ACADMDA = 0 
ACADMDS = 0 
ACADMDT = 0 
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The MODEX flag < > 0 indicates that a transition to ACAD mode 
MODEX is in progress. MODEX = 0 means that the previous 
transition is completed. 

Mode initiation Processing — This portion of the code is per- 
formed in MODEXIN = 1. This flag indicates that a new mode 
has been commanded. Table 5-5 indicates the functions exe- 
cuted by the various modes as well as their frequency. 

Table 5-6 describes the various variables that are initial- 
ized upon mode transition. Table 5-8 describes the various 
commands sent upon mode initialization. 

Additional Mode Transition Processing — In the VCM, the fol- 
lowing commands are issued and flags set depending on high- 
level thruster bank enablement. If an OAT bank is enabled, 
the ACTs are not used to control that particular axis. 

If MODEX = 7 (VCM) 

Then if B20N = 1 (roll high-level thruster bank on) 
Then issue command C.LLTDR to disable low-level 
roll thrusters 

LLF1 = 0 (disable LLTCON roll control) 

If BION = 1 (pitch high-level thruster bank on) 

Then issue command C.LLTDP to disable low-level 
pitch thrusters 

LLF2 = 0 (disable LLTCON pitch control) 

End if 
End if 

End if 

High-level thrusters are enabled in the VCM by the HLTCON 
function. 

Upon entry to SM, the standby counter is reset to 0 as 
follows : 


If (MODEX = 1) SBTIMEK = 0 
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Table 5-8. Commands Issued on Mode Initiation 


Mode Number 
— Mode Name 
Command Name J 


SJL 


2 3 4 5 6 7 

KMM SRPM SHM TMM VCM 


C . LLTD 
C . LLTE 
C . HLTD 
C.RWTZ 
C.MGTZ 
C.GHR 
C . FWRWS 
C.FWTHR 


X 

X 

X 

X 

X 


X 


X 

X 

X 

X 


X 

X 

X 


X 

X 

X 

X 

X 


X 

X 

X 


1 Comman d Names ; 
C . LLTD 
C . LLTE 
C . HLTD 
C.RWTZ 


Command low-level thrusters disabled 
Command low-level thrusters enabled 
Command high-level thrusters disabled 

Command zero reaction wheel torque commands to the 
reaction wheels 

Command zero magnetic torquer commands to the mag- 
netic torquers 

Command the gyros to the high rate 
Command to inform the firmware that the reaction 
wheels are the actuators in use (to ACE) 

Command to inform the firmware that the thrusters 
are the actuators m use (to ACE) 

b ® commanded to the low rate by the 
ground when the ground commands the spacecraft to the 
normal pointing mode. 


C.MGTZ 

C.GHR 
C. FWRWS 

C.FWTHR 
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The mode control for the OBC-controlled modes is now finished 
(i.e., SM, NPM, NMM, TMM, VCM) , and the mode transitions are 
thus complete. The mode transition control flag is reset to 
0 : 


If MODEX = (1, 2, 3, 6, or 7) 

ACADMD = MODEX 
MODEX = 0 
End if 

On transition to the backup modes SRPM and SHM, additional 
processing is needed. If ACAD hardware reconfiguration has 
been requested (RECREQ = 1) from SAFECON , the appropriate 
command must be issued. In the SRPM, the Sun acquisition 
test counters must be reset. In the SHM, a command must be 
issued to switch to the B-side low-level thrusters. 


If MODEX = (4 or 5) 

If RECREQ « 1 

Use B-side electronics 
If MODEX = 5 

Use B-side low-level thrusters 
End if 

SYNCK = SYNCTM/ 0.256 
RECREQ = 0 

Else (If RECREQ < > 1) 

SYNCK = 0 

Endif 
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The Sun acquisition test counters are set to 0 if the space- 
craft is transitioning to the SRPM (i.e., MODEX = 4). 

If MODEX = 4 

AQTAK = 0 
AQTBK = 0 

End if 

If MODEX = (4 or 5) Then 
ACADMD = MODEX 
MODEXIN = 0 

End if 

Safe Contingency Mode Tran sition P rocessing —' Thi s processing 
is done only if MODEX = 4 or 5. The OBC mode flag ACADMD has 
previously been set to the new mode. Therefore, the OBC will 

be operating in mode 4 or 5 while the following processing is 
taking place. 

Mode transition to the SRPM and SHM requires a series of 
commands to the ACAD firmware to reset the gyro channel se- 
lection flags and to identify the axes that must use derived 
rate. On entry to the SRPM, if a reaction wheel failure has 
been indicated (FAILW > 0), another series of firmware 
commands is needed to reset the failed wheel indicator and 
the reaction wheel transformation matrix. Normally, the 
ACAD electronics will have been reconfigured, and these com- 
mands must be delayed until the ACAD electronics is resyn- 
chronized . 

C.FWGYR = 0 

If SYNCK > 0 (ACAD reconfiguration in progress) 

Then SYNCK = SYNCK - 1 

If the reconfiguration is finished, the ACAD firmware gyro 
channel selection and derived rate axis flag indicator, 
C.FWGYR, is .set to 1, and the reaction wheel reconfiguration 
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flags are set (provided a wheel has failed and the spacecraft 
is transitioning to the SRPM) . 

C.FWGYR = 0 
If SYNCK < 0 Then 

C.FWGYR = 1 (reset the ACAD firmware gyro channel selec- 
tion and derived rate axis flags) 

C . FWRWX = 0 (do not reset reaction wheel matrix) 

If MODEX = 4 Then 

If FAILW > 0 Then 

C. FWRWX = 1 (reset reaction wheel matrix) 

Do for i = 1 to 4 

If FAILW < > i Then 

C.RWONi = 1 (reaction wheel i power on) 

End if 

Enddo 

C.FWSRP = 1 (initiate operation in SRPM) 

End if 

If MODEX = 5 

C.FWSH = 1 (initiate operation in SHM) 

End if 
End if 

This logic uses the value of the OBC failed wheel indicator, 
FAILW, as set by the ground or as reset by SAFECON, to set 
the corresponding flag in the firmware. FAILW is passed to 
the ACE. 

Computing the Valid Gvro Flags — The valid gyro flags that 
are sent to the firmware are set here provided the reset 
flag, C.FWGYR, is set. The values come from the OBC gyro 
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flag array, IGY^, and are assigned to the firmware array, 
IGF i . 


If C.FWGYR = 1 
Do for i * 1 to 3 

If I GY. = -l Then 

IGF(i) = l (derived rate required about axis i) 

IGF ( i + 3) = 0 

Else 

IGF(i) = o (good gyro data about axis i) 

IGF(i + 3) = IGY i 

End if 

Reconfiguring the Reacti on Wheel — The 3-by-4 reaction wheel 
command transformation matrix, TRWD, is set by this func- 
tion. The values are obtained from the OBC reaction wheel 
command transformation matrix, DW ijk , which contains five 
possible scenarios depending on which reaction wheel has 
failed, if any. The proper matrix is given to TRWD. 

If C.FWRWX = 1 Then 

Do for j = 1 to 4 and k = l to 3 

TRWD ( j , k) = DW. .. 

13 k 

Enddo 

where i = FAILW 

TRWD( j , k) = firmware reaction wheel transformation ma- 
trix where j = 1 to 4 and k = l to 3 

DW i j k = OBC flight software reaction wheel trans- 
formation matrix where i = 0 to 4 , i =1 
to 4 and k = 1 to 3 

Si m AcquisitiQn Test in SRPM — In the Sun reference pointing 
mode, a test for Sun acquisition is performed. If the Sun 
is not acquired before the time limit is exceeded, transi- 
tion to safe hold mode is requested. 
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If ACADMD = 4 and MODEX = 0 (transition to SRPM complete) 
Then if SUNPRS = 1 

Then AQTAK = AQTAK + 1 
If AQTAK > AQTAL 

Then AQTBK = 0 
Else AQTAK = 0 

AQTBK = AQTBK + 1 
If AQTBK > AQTBL 

Then set the MODECON request flag ACADMDA = 5 
to transition to SHM RECREQ = 1 

Standby Mode Timer — At entry to SM, a timer begins increment- 
ing. If the timer exceeds the specified time limit, transi- 
tion to SRPM is requested: 

If ACADMD » 1 and MODEX = 0 (transition to SM complete) 
Then 

SBTIMEK = SBTIMEK + 1 

End if 

If SBTIMEK > SBTIMEL 
Then 

Set the MODECON request flag ACADMDA = 4 to request 
transition to SRPM 

Endif 


• Output — MODECON produces the following: 


Name 


Descr ipt ion 


ACADMD 
ACADMDA 
ACADMDG 
ACADMD S 


ACAD mode status flag data base flag (to ATTERR, 
MODECON, ANTCON) 

Mode transition request flag from MODECON (to 
MODECON) 

Mode transition request flag from ground (to 
MODECON) 

Mode transition request flag from SAFECON (to 
MODECON) 
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Name 


Description 


ACADMDT 

ACSINT 

AECT 

ANTINIT 

AQTAK 

AQTBK 

ARCT 

C . FWRWS 

C.FWSH 

C . FWSRP 

C.FWTHR 

C.GHR 

C . HLTD 

C . LLTD 

C . LLTDP 

C . LLTDR 

C . LLTE 

C.MGTZ 

C.RWONi 

C.RWTZ 

CMDANT 

CMDBKT 


Mode transition request flag from HLTCON (to 
MODECON) 


ACS sample period DBC (to GYRODAT, EXEC, 
HLTCON, WHECON, MODECON) 


SAFECON, 


Attitude error comparison threshold (to SAFECON) 

ANTCON initialization flag (to ANTCON) 

Sun acquisition time counter A (to MODECON) 

Sun acquisition time counter B (to MODECON) 

Attitude rate comparison threshold (to SAFECON) 

Command to inform firmware that reaction wheels are 
the actuators in use (to ACE, Truth Model) 

Commands to ACAD firmware to initiate backup SHM 
(to ACE) 


Commands to ACAD firmware to initiate backup SRPM 
(to ACE) 

Command to inform firmware that thrusters are the 
actuators in use (to ACE, Truth Model) 

Command to the IRU to select gyro high-rate mode 
(to Truth Model) 

Commands to the propulsion electronics (PE) to dis- 
able all high-level thrusters (to Truth Model) 

Commands to the PE to disable all low-level 
thrusters (to Truth Model) 

Command to the PE to disable low-level pitch 
thruster firing (to Truth Model) 

Command to the PE to disable low-level roll 
thruster firing (to Truth Model) 

Commands to the PE to enable all low-level 
thrusters (to Truth Model) 

Zero magnetic torquer commands to the torquer drive 
electronics (TDE) (to Truth Model) 

Reaction wheel i power up command where i = 1, 2 
3, or 4 (to Truth Model) ' 

Zero reaction wheel torque commands to the RWEA 
(to Truth Model) 

Enablement flag for antenna commands (to ANTCON) 

Enablement flag for break track commands (to 
ATTEST) 
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Name 

CMDMAG 

CMDWHE 

FLTINIT 

GCCT 

GYRINIT 

HLTINIT 

LCAi 

LCBi 

LCCi 

LHYi 

LIMKEY 

LKPi 

LKRi 

LLFi 

LLTINIT 

LPLi 

MAGINIT 

MODEX 

MOMINIT 

RECREQ 

SBTIMEK 

SCMINIT 

SGCL 

STRAVGi 


Description 

Enablement flag for magnetic torquer commands (to 
MAGCON) 

Enablement flag for reaction wheel commands (to 
WHECON) 

ATTEST filter initialization flag (to ATTEST) 

Gyro channel comparison threshold (to SAFECON) 

GYRODAT initialization flag (to GYRODAT) 

Velocity control initialization flag (to HLTCON) 

Low-level thruster rate filter constant A where 
i = 1, 2, 3 (to LLTCON) 

Low-level thruster rate filter constant B where 
i = 1, 2, 3 (to LLTCON) 

Low-level thruster rate filter constant C where 
i = 1, 2, 3 (to LLTCON) 

Low-level thruster hysteresis constants where i = 

1, 2, 3 (to LLTCON) 

Keyhole region limit for current mode (to ANTCON) 

Low-level thruster position gains where i = 1, 2, 

3 (to LLTCON) 

Low-level thruster rate gains where i = 1, 2, 3 
(to LLTCON) 

Low-level thruster axis controlled flag where i = 

1, 2, 3 (to LLTCON) 

LLTCON initialization flag (to LLTCON) 

Position error limits where i = 1 to 3 (to LLTCON) 
MAGCON initialization flag (to MAGCON) 

Mode transition control flag (to MODECON) 

Momentum comparison initialization flag (to MOMCOM) 

Request for reconfiguration of ACAD hardware (to 
MODECON) 

Standby time counter (to MODECON) 

SAFECON initialization flag (to SAFECON) 

Single— axis gyro channel miscompare limit (to 
SAFECON) 

Averaging function execution flag for star tracker 
i where i = 1/ 2 (to STARAVG) 
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Name 


Description 


SYNCK 

TGCL 

THGCL 

WHEINIT 
5.2.4 .7 


ACAD hardware resynchronization counter (to 
MODECON) V 

Two-axis gyro channel miscompare limit (to SAFECON) 

Three-axis gyro channel miscompare limit (to 
SAFECON) v 

WHECON error initialization flag (to WHECON) 

Safe Contingency Mode Function 


The safe contingency mode function (SAFECON) provides a fail- 
ure detection and response capability for the EPDS power and 
ACADS. If out-of-tolerance conditions are detected, commands 
are issued to spacecraft subsystems, and requests are made to 
the mode control function (MODECON) for transition to safe 
contingency mode. 


Name 

ACADMD 
ACS I NT 
AECT 
AERK 

AERL 

ARCT 

Ei 

ENATTER 

ENGYBAK 

ENGYCOMP 

FAILW 

GCCT 


InEULt — SAFECON uses the following input: 
Description 


Current ACAD mode (from MODECON) 

ACS sample interval (from MODECON) 

Attitude error comparison threshold (from MODECON) 

SAFECOnJ 6 attitude error or rate counter (from 

Successive attitude error or rate limit (DBC) 

Attitude rate comparison threshold (from MODECON) 

Attitude errors (commanded minus actual) where i = 
1/ 2, 3 (from ATTERR) 

Enablement flag for attitude error and rate compar- 
ison; = l, enabled (from DBC/GND , SAFECON) 

Enablement flag for gyro channel comparison in 
backup mode; = 1 enabled (from DBC/GND, SAFECON) 

Enablement flag for gyro channel comparison; = l 
enabled (from DBC/GND, SAFECON) 

MODECON ^ eaC *" i0n Wh6el indicator < data base reset by 
Gyro channel comparison threshold (from MODECON) 
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Name 


Description 


GRBij 
GSFHij 
GSFLij 
PTNGi j 


REGERR 

REGK 

REGREQ 

REGREQP 

SCMINIT 

SENSTA 

SGCKi 

SGCL 

SINDi 

TGCKi 

TGCL 

THGCK 

THGCL 

THIND 

TINDi 

TNGij 

WOKi 


Nominal gyro rate biases for axis i (where i = 1, 

2, 3), channel j (where j = 1, 2) (DBCs) 

Gyro high-rate mode scale factors for axis i (where 
i = 1, 2, 3)/ channel j (where j = 1, 2) (DBCs) 

Gyro low rate mode scale factors for axis i (where 
i = 1, 2, 3), channel j (where j = 1, 2) (DBCs) 

Past value of OBC gyro counters for axis i (where 
i = 1, 2, 3), channel j (where j = 1, 2) (from 
SAFECON) 

Gyro register error flag (from GYRODAT) 

Gyro register error counter (from SAFECON) 

Hardware reconfiguration request flag (from 
MODECON) 

Flag indicating that firmware reconfiguration has 
occurred 

SAFECON initialization flag (from MODECON) 

Gyro rate status (from GYRODAT) 

Single-axis gyro miscompare counters for axis; 
where i * 1, 2 , 3 (from SAFECON) 

Successive single-axis gyro miscompare limit (from 
MODECON) 

Indicator that a single-axis failure has taken 
place on axis i where i = 1 to 3 (from SAFECON) 

Two-axis gyro miscompare counters for axis i where 
i = 1, 2, 3 (from SAFECON) 

Successive two-axis gyro miscompare limit (from 
MODECON) 

Three-axis miscompare counter 

Successive three-axis miscompare limit (from 
MODECON) 

Indicator that a three-axis gyro failure has taken 
place (from SAFECON) 

Indicator that a two-axis miscompare has taken 
place, with i being the good axis, where i = 1 to 
3 (from SAFECON) 

Cumulative OBC gyro counters for axis i (where i = 
1, 2, 3), channel j (where j = 1, 2) (from GYRODAT) 

Reaction wheel health flags where i = 1, 2, 3, 4 
(from WHECON) 
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Na me 


Description 


w i Spacecraft body rates where i = 1, 2 , 3 (from 

GYRODAT) 

ZWHOFFj Flag that indicates if wheel i is good (= 1) or 
bad ( = 0) (from DBC/GND) where i = 1 to 4 

• Processing ACAD monitoring is performed once every 
ACS sample period (ACSINT) in ACAD modes NPM, NMM, TMM, and 
VCM following GYRODAT. The SAFECON execution interval and 
ACAD modes in which it executes are shown in Table 5-6. 

If transition to a safe contingency mode (SRPM or SHM) is 
needed, the ACAD mode control function (MODECON) is requested 
to implement the transition. MODECON must know which gyros 
to use for which axes and which axis must use the derived 
rate. This information is specified by resetting the channel 
select flags, IGY i . In this respect, the requirement to use 
the derived rate (or in roll, to use magnetometer control) 
is specified by setting the channel select flag IGY^ = -l. 

In responding to attitude and rate errors, SAFECON also con- 
trols which reaction wheels to use. This is specified by re- 
setting the failed wheel indicator, FAILW. 

If reconfiguration of the ACAD hardware, nominally switching 
to B-side electronics, is required, the RECREQ request flag 
is set for implementation by MODECON. 

Each of the following limit-check functions and the asso- 
ciated commanding and mode transition responses is separately 
enabled and disabled by ground command. 

I nitialisation If initialization is requested (SCMINIT = l) , 
the gyro register error flags, the ACAD out-of-limit coun- 
ters, and the powered-off wheel status flag are reset: 

Do for i = 1 to 3 
SGCK. = 0 

l 

TGCK i = 0 
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THGCK = 0 
AERK = 0 
ZWHOFF i = 0 

Also, the past values of the OBC gyro counters are set: 


Do for i = 1 to 3 and j = 1 to 2 

PTNG. . = TNG. . - cumulative OBC gyro miscompa 
il il 


re in 


The initialization flag'SCMINIT is then reset to 0. Upon 
flight software initialization, attitude error and rate com- 
parisons are enabled: 


ENATTER = 1 
ENGYCOMP = 1 
ENGYBAK = 1 


Gvro Channel Comparison 

Gvro Channel Differences — The gyro channel compare func- 
tion is performed by first differencing the current and past 
values of the OBC gyro counters and then resetting the past 
values : 

Do for i = 1 to 3 and j = 1 to 2 (all channels) 

GI i j = TNG i j - PTNG i j 
PTNG i j = TNG i j 

GI^. is the angular increment in counts, and PTNG^j is the 
past value of the OBC gyro counter. 

The gyro angular increments are then corrected for scale 
factor and nominal gyro rate bias. The rate status for each 
gyro (not axis) is given by the corresponding bit of the 
rate status word, SENSTA. Although on GRO all gyros are set 
to the same rate, the possibility of different rates on dif- 
ferent gyros is provided for. 

Do for i = 1 to 3 and j = 1 to 2 (all channels) 

If BIT k = 0 
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Then GI^ = GI^ * GSFH^ ^ - GRB^ ^ * ACSINT 
Else GI^ = GI i j * GSFL i j - GRB i j * ACSINT 

BIT k the kth bit of SENSTA, k is determined as a function 
of i,j from Table 5-9, and GRB is the nominal gyro rate bias. 

GI ij 1S the ^yro increment in radians corrected for nominal 
gyro rate bias. 


Table 5 9. Gyro Channel Definitions 


. Axis ( i) 

Channel 

( i ) 

Roll (X) 1 

A 

i 

1 

B 

2 

Pitch (Y) 2 

A 

1 

2 

B 

2 

Yaw (z) 3 

A 

1 

3 

B 

2 


1 

3 

2 

3 

1 

2 


Next, the difference between the gyro increments on each axis 
is compared with the gyro comparison threshold. If the dif- 
ference exceeds the threshold, the axis miscompare flag, 

GMC^, is set: 


Do for i = 1 to 3 (all axes) 

DI i - GI il - GI i 2 
If ABS(DI.) > GCCT 

Then GMC. = 1 

Else GMC. = 0 

l 

The axis miscompare flags, GMC i , are temporary variables. 
GMC i = 1 indicates that a miscompare has occurred on axis i. 
DIi * s not a true rate because GI^ is not corrected for the 
sample period value, ACSINT. This must be considered in se- 
lecting values for GCCT. 
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Miscompare Type Determination — Next, it is determined 
whether a one-, two-, or three-axis miscompare has occurred 
and successive occurrences are counted: 

If GMC1 + GMC2 + GMC3 = 2 (two-axis miscompare) 

Then THGC = 0 

Do for i = 1 to 3 
SGCK i = 0 
If GMC i = 0 

Then TGCK i = TGCK i + 1 

Else TGCK i = 0 

Else if GMCI + GMC2 + GMC3 = 3 (three-axis miscompare) 

Then THGCK = THGCK + 1 
Do for i = 1 to 3 
SGCK i = 0 
TGCK i = 0 

Else If GMCI + GMC2 + GMC3 = 1 (single-axis miscompare) 

Then THGCK = 0 

Do for i = 1 to 3 
TGCK i = 0 
If GM^ = 1 

Then SGCK i = SGCK i + 1 

Else SGCK i = 0 

Else THGCK = 0 TGCK i = SGC^ = 0 for i = 1 to 3 (no 
miscompare) 

TGCK^ counts two-axis miscompares in which axis "i" is good 
and SGCKi counts single-axis miscompares in which axis "i" 
is bad . The miscompare counters are reset to zero if se- 
quential miscompares of the same type (single or two axis) 
on the same axis do not occur. 

Gvro Channel Definition — To implement the failure re- 
sponse for different types of miscompares, the relationship 
between axes (i), channels (j), and gyros (k) is required. 
This is shown in Table 5-9. 
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Eailuce Declaration an d Response — The last steps are to 
determine if a failure should be declared. If the sequen- 
tial miscompare counters exceed their limits, transition to 
SRPM or SHM is requested. 

For two-axis miscompares: 


Do for i = 1 to 3 

If TGCK^ > TGCL and ENGYCOMP = 1 

Then the gyro channel select flags, IGY i , are reset to se 
lect the good gyro channels, as shown in Table 5-10. 


Table 5-10. Gyro Selection for Two-Axis Miscompares 


Good Axis 
(i> 

1 

2 

3 


Bad 

fiYIQ 

2 

1 

3 


Gyro to Use for 
MU Pitch Yaw 

3 3 1 
3 2 2 
12 1 


Channel Selection 
IGYI IGY2 IGY3 

110 
10 1 
0 0 0 


Set the ACAD hardware reconfiguration request flags RECREQ = 
1, RECREQP = 1 

Set the two-axis miscompare flag to indicate that a failure 
has occurred and the good axis is i; TIND. = l 

If ACADMD = 6 or 7 (thruster modes) 

Then set mode transition request flag ACADMD S = 5 to 
transition to SHM 
If ACADMD = 2 or 3 (wheel modes) 

Then set mode transition request flag ACADMD S = 4 to 
transition to SRPM 

The good gyro channels for two-axis miscompares are selected 
by noting that "i" indicates the good axis and the other two 
axes are bad. Therefore, the presumption is that the gyro 
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common to the other two axes is the bad one and should not 
be used. This logic is stated in Table 5-10. 

The channel selection in this case is somewhat arbitrary be- 
cause four good channels are available and only three are 
required . 

For single-axis miscompares: 

Do for i = 1 to 3 

If SGCK^ > SGCL and ENGYCOMP = 1 

Then reset gyro channel select flags, IGY^, to select 
the good gyro and derived rate on the third axis as 
shown in Table 5-11 

Set ACAD hardware reconfiguration request flags RECREQ = 
1, RECREQP = 1 

Set the single-axis failure flag to indicate that a fail- 
ure on axis i has taken place; SIND^ = 1 

If ACADMD = 6 or 7 (thruster modes) 

Then set mode transition request flag ACADMDS = 5 to 
transition to SHM 
If ACADMD = 2 or 3 (wheel modes) 

Then set mode transition request flag ACADMDS = 4 to 
transition to SRPM 

Table 5-11. Gyro Selection for Single-Axis Miscompares 


„ _ Gyro to Use for Channel Selection 
Bad Axis Bad 1 
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For single-axis miscompares, ”i“ indicates the bad axis. 

This means that one or both channels used for axis i are 
bad, that is, the derived rate must be used on that axis (or 
in the case of the roll axis, magnetometer control). it 
also implies (but does not prove) that the two gyros on 
axis i may be bad and should not be used. Table 5-11 shows 

this logic, where IGY^ = -l indicates use of the derived 
rate. 

The channel selection in this case is unique because of the 
assumption that both gyros on axis i are bad, leaving only 
one gyro for the other two axes. 

For three-axis miscompares: 

If THGCK > THGCL and ENGYCOMP = 1 
Then 

Set gyro channel select flags IGY. = -l, (i = 

3) to select derived rate on all axes 

Set hardware reconfiguration request flags RECREQ = 

1, RECREQP = l 

Set three-axis miscompare indicator THIND = l 
Disable gyro checking in backup mode by setting 
ENGYBAK =0 

Request transition to SHM by setting ACADMDS = 5 

The following is done when the spacecraft is in a backup mode 
(SHM or SRPM) . 

For two-axis miscompares: When a two-axis miscompare occurs 

in the SHM or SRPM, the gyros will be considered to be 
degraded" ( 1 ) if a prior two-axis miscompare has occurred 
with a different good axis or (2) if a prior single-axis 
miscompare has occurred on the axis that is now considered 
to be good. The response in the SRPM is to wait until Sun 
presence time-out, then go to SHM using three-axis derived 
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rate. The response in the SHM is to change gyros immediately 
to three-axis derived rate. 

Do for i = 1 to 3 

If TGCK^ > TGCL and ENGYBAK = 1 
Then 

Do for k = 1 to 3 

If (TIND^ <> 0 and i<>k) or SIND^^ = 1 or 

SIND k = TIND k for all k 

Then 

Set two-axis miscompare indicator, TIND^ = 1 
Reset gyro channel select flags 
IGY.^ = -1 (i = 1, 3) to select derived rate 
on all axes 

Disable gyro checks in backup modes 
ENGYBAK = 0 
If ACADMD = 4 
Then 

Request hardware reconfiguration 
RECREQ = RECREQP * 1 
Else if ACADMD = 5 
Then 

Request hardware configuration if not 

already done 

If RECREQP = 0 

Then RECREQP = RECREQ = 1 

Request SHM 

ACADMD S = 5 

End if 

End if 
Enddo 

Endif 

Enddo 
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For single-axis miscompares: When a single-axis miscompare 

occurs in a backup mode, the gyros will be considered to be 
degraded (1) if a prior single-axis miscompare has occurred 
on a different axis, (2) if any prior two-axis miscompare 
has occurred, or (3) if no prior miscompare has occurred. 

Do for i = 1 to 3 

If SGCK^ > SGCL and ENGYBAK = 1 
Then 

4 

If SIND^ <> o and k<>i or 
TIND k <> 0 or 

(SIND r = TIND R = 0 for all k) 

Then 

Set single-axis miscompare indicator, SIND. 

= 1 1 

Reset gyro channel select flags IGY. = -l, 

<i = 1, 3) to select derived rate on all axes 
Disable gyro checks in backup modes 
ENGYBAK = 0 
If ACADMD « 4 
Then 

Request hardware reconfiguration 
RECREQ = RECREQP = 1 
Else if ACADMD = 5 
Then 

Request hardware reconfiguration if not 

already done 

If RECREQP = 0 

Then RECREQ = RECREQP = 1 

Request SHM 

ACADMDS = 5 

End if 

End if 

End if 
Enddo 
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For three-axis miscompares : Any new three-axis miscompare 

in a backup mode is considered to be a gyro degradation. 

If THGCK > THGCL and 
ENGYBAK = 1 and 
THIND = 0 

Then 

Set three-axis miscompare indicator 
THIND = 1 

Reset gyro channel select flags IGY^ = -1, (i = 

1, 3) to select derived rate on all axes 
Disable gyro checks in backup modes 
ENGYBAK = 0 
If ACADMD = 4 
Then 

Request hardware reconfiguration 
RECREQ = RECREQP = 1 
Else if ACADMD » 5 
Then 

Request hardware configuration if not already 
done 

If RECREQP = 0 
Then RECREQP = RECREQ = 1 
Request SHM 
ACADMD S = 5 

Endif 

End if 

Attitude Error and Attitude Rate Comparison — If any attitude 
error (E^) or body rate (V^) exceeds its threshold consecu- 
tively for more intervals than the specified limit (AERL) , 
transition to SRPM or SHM is requested. The thresholds (AECT 
and ARCT) are set by MODECON before attitude maneuvers to 
preclude undesired transitions during maneuver transients. 
This is necessary because the initial attitude error during 
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a maneuver will be equal to the commanded attitude change, 
which may be as large as 180 degrees. 

If mode transition is to be requested, a check of reaction 
wheel health is made before requesting mode transition. if 
ACAD is not in a thruster mode and at least three wheels are 
good, transition to SRPM is requested. Otherwise, transi- 
tion to SHM is requested. 

If ABS(El) > AECT or ABS(Wl) > ARCT or 

ABS(E2) > AECT or ABS(W2) > ARCT or 

ABS(E3) > AECT or ABS(W3) > ARCT 

Then AERK = AERK + 1 
Else AERK = 0 

If AERK > AERL and ENATTER = 1 

Then set ACAD hardware reconfiguration request flag 
RECREQ = 1, RECREQP « 1 
If ACADMD = 2 or 3 (wheel modes) 

Then 

If ZWHOFF^ + ZWHOFF 2 + ZWHOFF 3 + ZWHOFF < 3 
Request SHM 4 

ACADMDS = 5 

Else 

Request SRPM 
ACADMDS = 4 

Else 

Request SHM 
ACADMDS = 5 

This logic uses a single counter (AERK) for all errors, and 
sequential errors on different axes are all counted. The 
failed wheel indicator, FAILW, may be reset based on the re- 
sults of the reaction wheel tests conducted in SAFECON if 
previously it was set to zero. 
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Reaction Wheel Correction — Responses to reaction wheel 
failures are based on information regarding reaction wheel 
failures reported by WHECON (WOK i ) and information regard- 
ing reaction wheel health (ZWHOFF^. All failures should be 
flagged; failed wheels should be turned off; and/ if possi- 
ble/ a good wheel should be turned on if it has been turned 
off by the ground. To turn off a good wheel from the ground, 
commands must be sent to set FAILW = 1 and ZWHOFF^ = 1 for 
wheel i. 

To operate with fewer than three wheels, the ground must load 
an appropriate steering matrix (DWijk), set ZWHOFF^ = 0 for 
each of the failed wheels, and set FAILW = the highest num- 
bered failed wheel (i = 1,4). 

If ZWHOFF ^ <> WOK i for any i and 
ACADMD = 2 or 3 and 
AMCONTROL = OBC 
Then 

WHEOK = WOI^ + WOK 2 + WOK 3 + WOK 4 

If WHEOK * 3 

Then 

If FAILW = 0 
Then 

Do for i = 1,4 

If WOK i = 0, then FAILW » 1 
Send command C.RWOFF^ to turn off wheel i 
Set ZWHOFF i = 0 
Else if ZWHOFF ( FA I LW ) = 1 

Send command C.RWON(FAILW) to turn on wheel FAILW 
Set WHEINIT = 1 to reset failure detection logic 
in WHECON 
Do for i = 1,4 

If WOF i = 0, then FAILW = 1 

Send command C.RWOFF^ to turn off wheel i 

Set ZWHOFF i = 0 
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• 

Name 

ACADMDS 

AERK 

ENATTER 

ENGYBAK 

ENGYCOMP 

FAILW 


IGYi 

PTNGij 


RECREQ 

REGERR 

REGK 

REGREQP 

SGCKi 

SINDj 

TGCKi 


Else 

Do for i = 1,4 

If WOK i = 0, then FAILW = i 

Send command C.RWOFF^ to turn off wheel i 

Set ZWHOFF . =0 
i 

Else if WHEOK < 3 

Do for i = 1,4 

If WOK i = o, then FAILW = i 

Send command C.RWOFF^ to turn off wheel i 

Set ZWHOFF. = o 
x 

Q utPVt — SAFECON produces the following output: 




Mode transition request (to MODECON) 

Attitude error or rate counter (to SAFECON) 

Enablement flag for attitude error and rate compar- 
ison, = 1, enabled (to SAFECON) 

Enablement flag for gyro channel comparison in 
backup mode; = l enabled (from DBC/GND , SAFECON) 

enabled 6 " to^SAFECON) Channel c°*Parison; , i, 

MODECON ^and ^SAFECON) indiCat ° r < to “^CON, 

Gyro channel selection flags for axis i where i = 

1 / 2 , 3 (to GYRODAT and MODECON) 

(wherl a i“? cumulative ayro counters for axis i 
^wnere i - l, 2, 3), channel j (where i = 1 2) 

(to SAFECON) J ' } 

ACAD reconfiguration request (to MODECON) 

Gyro register error flag (to SAFECON, GYRODAT) 

Gyro register error counter (to SAFECON) 

oc22rred iCatin9 that £irnlMar6 reconfiguration has 

? in ? le ~ a f is mi scompare counter for axis i where i - 
1/ 2, 3 (to SAFECON) 6 1 ~ 

^ hat u a si ngle-axis failure has taken 
place on axis where i = 1 - 3 (from SAFECON) 

r°3~ a (io siisr counter for axis 1 where 1 - ^ 
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Name 


Description 


THGCK 

THGCL 

THIND 

TINDi 

ZWHOFFi 


Three-axis miscompare counter 

Successive three-axis miscompare limit (from 
MODECON) 

Indicates that a three-axis gyro failure has taken 
place (from SAFECON) 

Two-axis miscompare file where i = 1 to 3 (from 
SAFECON) 

Flag that indicates if wheel i is good (=1) or bad 
(=0) (to SAFECON) 


5.2.5 ANTENNA POINTING COMMAND PROCESSING 


The antenna pointing command processing function (ANTCON) 
uses current antenna gimbal angles and ephemeris and atti- 
tude data to compute desired gimbal angles and gimbal slew 
commands as shown below. 


Input — ANTCON uses the following input: 


Name 


Description 


ACADMD 

ALIMIT1 

ALIMIT2 

ANTij 


AZBIAS 

AZRES 

BIAZ 

CMDANT 

ELBIAS 

ELIMIT1 

ELIMIT2 

ELRES 


ACAD status flag (from MODECON) 

Antenna azimuth limit 1 (DBC) 

Antenna azimuth limit 2 (DBC) 

Elements of 3-by-3 coordinate transformation 
from ACAD body axes where j = X, Y, Z to antenna 
body axes where i = X, Y, Z (DBC) 

Azimuth resolver output bias (DBC) 

Current gimbal azimuth angle resolver output 
(from Truth Model) 

Data base flag (set by ground) used to prevent 
azimuth gimbal limiting (= 0, normal; = 1/ 
180-deg flip) (DBC) 

Enable flag for antenna commanding; = 0, no; 

= 1, yes (from DBC/GROUND, MODECON) 

Elevation resolver output bias (DBC) 

Antenna elevation limit 1 (DBCs) 

Antenna elevation limit 2 (DBCs) 

Current gimbal elevation angle resolver output 
(output of gimbal drive electronics every 
128 msec) 
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Name 


Description 


EPAi 


GROPi 

ITDRS 

KI 

KP 

LIM1 

LIM2 

LIM3 

LIM4 

LIM5 

LIM6 

LIMKEY 

LIMKEY2 

ANTINIT 

RPC 

TARATTi 


TDREPi 

TDRWPj 

TSAN 


Updated Euler parameters that specify the ACAD 
body axis orientation with respect to the ECI 

DBC/GROUND^ 1 ’ 1 t0 4 <P« a ">eter s from KININT, 


GRO position in ECI coordinates where i = x Y 
Z (parameters from EPHEM) ' ' 


Data base flag set by ground command to 
which TDRS to use (= 0, TDRS-East ; = l 
West) (DBC) 


indicate 

TDRS- 


Integral gain (DBC) 


Proportional gain (DBC) 


Integral error limit (DBC) 

Linear proportional error limit (DBC) 

Nonlinear proportional gain slope factor (DBC) 
Maximum slew rate limit (DBC) 

Slew acceleration limit (DBC) 

Stepper motor scale factor (DBC) 

Keyhole region (from MODECON) 

Keyhole region 2 (DBC) 


initialization fiag for ANTCON (= l, initialize 
- 0, do not initialize) (DBC) 

Gimbal resolver scale factor (DBC) 

Parameters that specify com- 
manded ACAD body axes with respect to the ECI 

ESTIMATION) ~ 1 t0 4 (Parameters from ATTITUDE 


TDRS-East current 
where i = X, Y, Z 

TDRS-West current 
where i = X, Y, Z 


position in ECI coordinates 
(from ephem) 

position in ECI coordinates 
(from ephem) 


(DBC) 1 " 9 period < cor "PUtation interval) of ANTCON 


• El flcessinq — Initialization of ANTCON is executed 
within 128 msec. TDRS selection and gimbal angle generation 
are executed every 0.512 sec. ANTCON is executed after at- 
titude error and before wheel control. 
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Initialization — If ANTINIT = 1, the following initialization 
takes place: 


OLDAZ = (AZRES - AZBIAS) * RPC 
OLDEL = (ELRES - ELBIAS) * RPC 
ELOUT1 = AZOUT1 = ELERR1 = AZERR1 = 0 
IACCEL = IACCAZ = ANTINIT = 0 


where AZERR1 
AZOUT1 

ELOUT1 

ELERR1 

IACCAZ 

IACCEL 


old value of azimuth error signal (see below) 

old value of integration for azimuth (see 
below) 

old output of integration for elevation (see 
below) 

old value of elevation error signal (see 
below) 

feedback value of acceleration limited steps 
for azimuth 

feedback value of acceleration limited steps 
for elevation 


If ANTINIT = 0, no initialization is performed, and the re- 
mainder of ANTCON is executed with the old values of the 
above parameters. 


TDRS Selection — The position data from TDRS-East or TDRS- 
West are selected as follows: 


If ITDRS = 0, then 


TDREPH i = TDREP i for i = X, Y, Z 

where TDREPH^ is ephemeris position data for selected TDRS. 
Otherwise (ITDRS = 1) 

TDREPH . = TDRWP . for i = X, Y, Z 

l l 
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Gimbal Angle Ge neration — The gimbal angles needed for pro- 
portional and integral control are computed. The LOS vector 
components between the GRO and TDRS spacecraft are computed 
by the following equation: 

RLOS i = TDREPH i - GROP i for i = X, Y, Z 

where RLOS^ is the LOS vector from GRO to TDRS. 

The LOS vector is then normalized to a unit vector: 

RLOS i = RLOS^RLOSM for i = X, Y, Z 

where RLOSM is ^RLOSX 2 + RLOSY 2 + RLOSZ 2 

Using the commanded Euler symmetric parameters EPA., RLOS. 
is transformed from the ECI coordinate system to ACAD body 
coordinates as follows: 

RLOSB i = XFORM ( RLOS , EPA, -1) 

where RLOSBi = normalized LOS vector in spacecraft coordi- 
nates for i = X, Y, Z 

XFORM = defined in Section 5. 2. 3. 4, Attitude Estima- 
tion Function, Processing subsection, 
paragraph entitled Vector Coordinate Transfor- 
mation 

EPA = (EPA X , EPA 2 , EPA 3 , TARATT 4 ) 
and RLOS is defined above. 

The RLOSB vector is then converted from spacecraft coordi- 
nates to antenna coordinates by the following: 

RLOSA x = ANT^ * RLOSB x + ANT^ * RLOSB^ + ANT XZ * RLOSB z 
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RLOSA^ = ANT^ * RLOSB x + ANT^ * RLOSB y + ANT yz * RLOSB z 

RLOSA z = ANT zx * RLOSB x + ANT zy * RLOSB y + ANT ZZ * RLOSB z 

where RLOSA^ represents normalized LOS vector components 
in antenna coordinates for i = X, Y, Z. 

The desired elevation gimbal angle is now computed as 
follows: 


ELANG = ARCCOS ( RLOSA3 ) 

The antenna elevation angle is then adjusted as a function 
of BIAZ (bidirectional azimuth external command) . 

If BIAZ = 1, then 


ELANG = -ELANG 

where ELANG is the desired (commanded) elevation angle of 
the GRO antenna . 

In normal pointing mode (ACADMD =2), if the LOS is in the 
antenna keyhole region, that is, the elevation angle ELANG 
is near zero, the coordinate transformation to antenna axes 
is redone using the commanded attitude, TARATT^, rather 
than the actual attitude, EPA i . The keyhole region test 
is performed as follows: 

If ACADMD =2 and I ELANG I < LIMKEY 
Then KEY = 1 

Else KEY = 0 

If KEY = 1 
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Then perform antenna transformations over: 

RLOSB = XFORM ( RLOS , TARATT, -1) 

RLOSA x = ANT xx * RLOSB + ANT * RLOSB + ANT * RLOSB 

y xz 2 

RLOSA y = ANT yx * RLOSB x + ANT * RLOSB + ANT * RLOSB 

1 * y yz 2 

RLOSA z = ANT zx * RLOSB + ANT * -RLOSB + ANT * RLOSB 

*y y zz z 

where RLOSA. represents the new LOS vector components in an- 
tenna coordinates for i = X, Y, Z. 

The antenna elevation and azimuth angles are updated as 
follows : 

If |ELANG| > ELIMIT2, 


ELANG = OLDEL 
AZANG = OLDAZ 

where AZANG = desired (commanded) azimuth angle of GRO 
antenna 

OLDAZ = previous cycle's (old) value of AZANG 
OLDEL = previous cycle's (old) value of ELANG 

If ABS( ELANG) < = ELIMIT2 , perform the following: 

If ACADMD = 2 (NPM) Then 
If | ELANG | < LIMKEY2 


ELANG = 0 
AZANG = 0 
FLAG = 0 
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Otherwise, |ELANG| > LIMKEY2 
FLAG = 1 

Otherwise, ACADMD is not equal to 2 (NPM) 

Then 

If ABS (ELANG) < LIMKEY 
ELANG = OLDEL 
AZANG = OLDAZ 
FLAG = 0 
Else FLAG = 1 

If FLAG = 1, then perform the following: 

If BIAZ = 0 

Then AZANG = AT AN 2 (RLOSAy, -RLOSA^ 

If BIAZ = 1 

Then AZANG = ATAN2 ( -RLOSAy , RLOSA^) 

where AT AN 2 is a two-argument arc tangent defined over the 
four quadrants with an output between -ir and ir and defined 
as follows: 

ATAN2 (y/x) = -i r + arctan (y/x) 

= -ir/2 

= arctan y/x 
= ir/2 

= ir + arctan (y/x) 

= undefined 

Arctan (y/x) is a one-argument 
between +ir/2 . 

The difference between the new 
then computed: 

DAZ = AZANG - OLDAZ 


for x < 0, y < 0 

for x = 0, y < 0 

for x > 0 

for x = 0, y > 0 

for x < 0, y > = 0 

for x = 0, y = 0 

arc tangent with an output 


and old azimuth angles is 
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The azimuth angle is adjusted using this difference: 

If DAZ > i r, AZANG = AZANG - 2tr 
If DAZ < -ir, AZANG = AZANG + 2ir 

Otherwise, there is no change in AZANG. 

The azimuth angle is further constrained as follows: 

If AZANG > ALIMIT2, AZANG = AZANG - 2ir 
If AZANG < -ALIMIT2, AZANG = AZANG + 2ir 

Otherwise, there is no change in AZANG. 

If FLAG = 0, do not change AZANG. 

The present values of AZANG and ELANG are then saved for the 
next iteration: 


OLDAZ = AZANG 
OLDEL = ELANG 

The following constraints are then applied to the azimuth 
angle : 

If AZANG > ALIMIT1, AZANG = ALIMIT1 
If AZANG < -ALIMIT1 , AZANG = -ALIMIT1 

Otherwise, there is no change in AZANG. 

Similar constraints are applied to the elevation angle: 

If ELANG > ELIMIT1, ELANG = ELIMIT1 
If ELANG < -ELIMIT1 , ELANG = -ELIMIT1 

Otherwise, there is no change in ELANG. 

Compensation/Slew Computations — Azimuth and elevation errors 
are generated by differencing the desired angles calculated 
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in the previous subsection, Girnbal Angle Generation, with 
the resolver output: 


AZERR2 = AZANG - (AZRES - AZ.BIAS) * RPC 

ELERR2 = ELANG - (ELRES - ELBIAS) * RPC 

where AZERR2 and ELERR2 are new values of azimuth and eleva- 
tion errors. 

Trapezoidal integration is used as follows: 

AZOUT2 = AZOUT1 + (AZERR2 + AZERR1) * TSAN * (0.5) 

ELOUT2 = ELOUT1 + (ELERR2 + ELERR1) * TSAN * (0.5) 

where AZOUT2 , ELOUT2 = new output of integration for azimuth 

and elevation 

AZOUT1 , ELOUT1 = old output of integration for azimuth 

and elevation 

AZERR1 , ELERR1 = old values of azimuth and elevation 

errors as shown below 

This output is then limited as follows: 

If AZOUT2 > LIM1, AZOUT2 = LIM1 
If AZOUT2 < -LIM1, AZOUT2 = -LIM1 

Otherwise, there is no change in AZOUT2 . 

If ELOUT2 > LIM1, ELOUT2 = LIM1 
If ELOUT2 < -LIM1, ELOUT2 = -LIM1 

Otherwise, there is no change in ELOUT2. 

A nonlinear proportional gain is implemented as follows: 

AZKP = KP * AZERR2 
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If AZERR2 > LIM2 


AZKP = LIM2 * KP + (AZERR2 - LIM2) * KP * LIM3 


If AZERR2 < -LIM2 

AZKP = -LIM2 * KP + (AZERR2 + LIM2) * KP * LIM3 

Otherwise, there is no change in AZKP, where AZKP is the 
nonlinear proportional gain output in azimuth; 

ELKP = KP * ELERR2 


If ELERR2 > LIM2, 


ELKP - LIM2 * KP + (ELERR2 - LIM2) * KP * LIM3 


If ELERR2 < -LIM2, 

ELKP = -LIM2 * KP + (ELERR2 + LIM2) * KP * LIM3 

Otherwise, there is no change in ELKP, where ELKP is the 
nonlinear proportional gain output in elevation. 

The new values of the azimuth and elevation errors and out- 
put of integration are saved for the next computation time: 

AZERR1 = AZERR2 

ELERR1 = ELERR2 
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AZ0UT1 = AZOUT2 


ELOUT1 = ELOUT2 

The PI control output is computed as 

AZCON = AZKP + AZOUT2 * KI 
ELCON = ELKP + ELOUT2 * KI 

where AZCON and ELCON are azimuth and elevation PI control 
output . 

This output is then converted to steps: 

AZSTP = LIM6 * AZCON 
ELSTP = LIM6 * ELCON 

where AZSTP and ELSTP represent azimuth and elevation PI 
control output in steps. 

The azimuth commanded steps are rounded to the nearest 
integer. 

If AZSTP <0, IX = -1 
Otherwise, IX = +1 

IRTAZ = IX * INT(|AZSTP| + 0.5) 

where IX = intermediate sign parameter 

IRTAZ = commanded step in azimuth (integer) 

INT(a) means take the integer portion of a. 

Similarly, the elevation commanded steps are rounded to the 
nearest integer. 
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If ELSTP <0, IX = -1 
Otherwise, IX = +1, 

IRTEL = IX * INT(|ELSTP| +0.5) 

where IRTEL is the commanded step in elevation (integer). 

The commanded azimuth step is limited to the stepper moto 
maximum slew rate as follows: 

If IRTAZ > LIM4 , IRTAZ = LIM4 
If IRTAZ < -LIM4 , IRTAZ = -LIM4 

Otherwise, there is no change in IRTAZ. 

Similarly, the commanded elevation step is limited 

If IRTEL > LIM4, IRTEL = LIM4 
If IRTEL < -LIM4, IRTEL = -LIM4 

Otherwise, there is no change in IRTEL. 

The commanded azimuth step is acceleration-limited as 
follows : 


IXAZ = IRTAZ - IACCAZ 

where IXAZ = intermediate value of acceleration-limited 

azimuth step command 

IACCAZ = value of azimuth stepper motor slew command 
from last cycle (see below) 

If IXAZ > LIM5, IXAZ = LIM5 
If IXAZ < -LIM5, IXAZ = -LIM5 

Otherwise, there is no change in IXAZ. 

Similarly, the commanded elevation step is acceleration- 
limited as follows: 


IXEL = IRTEL - I ACCEL 
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where IXEL = intermediate value of acceleration-limited 

elevation step command 

IACCEL = value of elevation stepper motor slew command 
from last cycle (see below) 

If IXEL > LIM5, IXEL = LIM5 
If IXEL < -LIM5 / IXEL = -LIM5 

Otherwise, there is no change in IXEL. 

The final step commands to be sent to the stepper motors are 
computed as follows: 


AZSLEW = IACCAZ + IXAZ 
ELSLEW = IACCEL + IXEL 

where AZSLEW and ELSLEW represent azimuth and elevation slew 
command output to the stepper motors. 

The azimuth and elevation slew commands, C.ANAZ and C.ANEL, 
are formed from AZSLEW and ELSLEW and are output to the 
stepper motors each computation cycle. 

The above commands are issued before the next computation 
interval for WHECON is started. 

The commanded step values are saved for the next computation 
frame, as follows: 


IACCAZ = AZSLEW 
IACCEL = ELSLEW 


* 
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If commanding is prohibited, the commands to the antenna 
drive are set to zero as follows: 

If COMDANT * 1 
C.ANAZ = 0 
C.ANEL = 0 

End if 


Name 


Output ANTCON produces the following output: 
Description 


C.ANAZ 
C . ANEL 


Azimuth slew command output to the azimuth 
stepper motor (to Truth Model) 

Elevation slew command output to the elevation 
stepper motor (to Truth Model) 
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SECTION 6 - ATTITUDE CONTROL ELECTRONICS 


6.1 SENSOR DATA PROCESSING 

6.1.1 GYRO DATA PROCESSING 

The gyro data consist of six gyro channels (X,Y,Z-prime and 
X, Y, Z-backup) . The prime and backup channel selection is 
made in the OBC and given to the ACE in the form of gyro 
channel flags. In the case of an OBC failure, the ACE has 
its own defaults for prime and backup channel flags. The 
gyro data input to this function represent the total motion 
detected by the gyro. This function is performed every 
128 msec. The entry (DBC) beside a variable indicates a 
data base constant that the ground can update. 

6 . 1.1.1 Input/Output 

• From the Truth Model 

GYRANG^ — gyro roll axis data, gyro 1 (rad) 

GYRANG 2 — gyro roll axis data, gyro 3 (rad) 

GYRANG- — gyro pitch axis data, gyro 2 (rad) 
o 

GYRANG^ — gyro pitch axis data, gyro 3 (rad) 

GYRANG-. — gyro yaw axis data, gyro 1 (rad) 

D 

GYRANG, — gyro yaw axis data, gyro 2 (rad) 

• From the OBC (or Ground) 

IGFi = 0, good roll axis data; = 1, bad roll axis 
data (DBC) 

IGF2 = 0, good pitch axis data; = 1, bad pitch 
axis data (DBC) 

IGF3 = 0, good yaw axis data; = 1, bad yaw axis 
data (DBC) 

IGF4 = 0, use channel 1 data; = 1, use channel 2 
(DBC) 

IGF5 = 0, use channel 3 data; = 1, use channel 4 
(DBC) 
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IGF 6 = 0, use channel 5 data; = 1, use channel 6 
(DBC) 

• From Computational Scheduling 

INITT — initialize thruster control flag 
INITW — initialize reaction wheel control flag 
IAH — attitude hold flag 
ISCAN — roll scan flag 

• From Attitude Error Computation 

IECL — eclipse flag 

• To Attitude Error Computation 

G x — gyro roll rate (rad/sec) 

Gy--gyro pitch rate (rad/sec) 

G z — gyro yaw rate (rad/sec) 

THETA^. — gyro roll position error (rad) 
THETAy--gyro pitch position error (rad) 

THETA z — gyro yaw position error (rad) 

• Initialization 

GREFj. = 0; i = l to 6 as the default 
6. 1.1. 2 Algorithm 

1. Convert radians to counts 

Since the gyro data from the Truth Model are in radians, 
these data first need to be converted to counts: 

GD. = (GYRANG. - B )/A i=l to 6 

i i gyro 7 gyro 

where for i=l to 6 


GD i = gyro output in counts (i=l to 6) 

GYRANG ^ = gyro output from the Truth Model (rad) 
B gyro = conver sion factor (rad) (DBC) 

A gy ro = conversion factor (rad/count) (DBC) 
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2 . 


Process data 


Subtract the past value of GD (GDP) from the current value 
and store the current value of GD into GDP: 

DNG . = GD. - GPD. i=l to 6 
11 i 

GDP i = GD i 

Each gyro shall be compensated (CBIAS^) for drift every 
CNBIAS^ (i=l to 6) cycles according to the following: 

DNGC i = DNGC i + CBIAS i i=l to 6 

Sum the computed differences according to 

SUM i = SUM i + DNGC i i=l to 6 

Limit DNGC i to ± 512 counts: 

GPER^ = GREF ^ - SOWL i = l to 6 

Limit GPER i to ± 2 15 counts for i=l to 6. 
where for i=l to 6: 

Parameter 

DNGC^ = raw gyro data differences (counts) 

SUMi = accumulated count differences 
(counts) 

CBIASi = gyro drift estimate (counts) 

(DBC) 

CNBIASi = drift update period (cycles) 

(DBC) 

GREFi = gyro count reference (counts) 

(DBC) 

GPER^ = gyro count accumulated (counts) 

GDP^ = past value of GD^ 

3. Select gyro channels to be used 
a. Roll 

(1) If the roll data are bad, set the attitude 
error and rates to 0 and continue with the 
pitch selection. 

6-3 


Range 

+ 1350 counts 
+ 2**23 counts 

+ 50 counts 

+ 2**7 cycles 

+ 2**15 counts 

+ 2**15 counts 
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( 2 ) 


If IGF 

G 

D 


^ is not equal to 0 

roll = 0 
roll = 0 


Else 


Using the IGF^ flag, the proper gyro channel 
data are used. 

If IGF. = 0 
4 


roll - 

D roll * DNGC l 

Else 


roll " 2 

D roll DNGC 2 

End if 

where G roll = selected roll count sum (counts) 

D roll = sel ected roll count difference (counts) 

IGF 1 = 0 , good roll axis data; = 1 , bad roll axis 
data (DBC) 

IGF 4 = 0, use channel 1 data; = 1, use channel 2 
data (DBC) 

b. Pitch 


(1) if the pitch gyro data are bad, the pitch and 
rate error are set to 0 . 

If IGF 2 is not equal to 0 

G pitch = 0 
D pitch “ 0 

Else 

(2) Using the IGF flag, the proper pitch gyro 
channel is selected for the attitude and rate 
error . 
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0 


where 


c . 


If igf 5 = 

G pitch 

D pitch 

Else 


gper 3 

dngc 3 


G pitch 

G pitch 


GPER . 
4 

DNGC. 

4 


End if 


G pitch 

D pitch 
IGF, = 

IGF 5 = 


selected pitch count sum (counts) 
selected pitch count difference (counts) 

0, good pitch data; = 1, bad pitch data (DBC) 

0, use channel 3 data; = 1, use channel 4 data 
(DBC) 


Yaw 

(1) If the yaw gyro data are bad, the yaw and rate 
error are set to 0. 


If IGF 3 is 
G 

yaw 

D 

yaw 


not equal to 

= 0 
= 0 


0 


Else 


(2) The proper yaw gyro channel is selected. 


If IGFg = 0 


G 

yaw 

D 

yaw 


Else 


gper 5 

dngc 5 


G yaw 

D yaw 


End if 


GPERg 

DNGCg 
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where 


= selected yaw count sum (counts) 

D yaw = selec ted yaw count difference (counts) 

IGF 3 = 0, good yaw axis data; = 1, bad yaw axis data 
(DBC) 

IGF 5 = 0/ use channel 5 data; = 1 , use channel 6 data 
(DBC) 

4. Calculate gyro attitude error estimate 




CTG 11 

CTG 12 

CTG 13 


G roll 

>1 

2 ) ( 

= CGP • 

CTG 21 

CTG 22 

CTG 23 

• 

G pitch 

LM 


CTG 3 1 

CTG 32 

CTG 33 


G 

yaw 


where CGP - gyro position scale factor (rad/count) (DBC) 

CTGij = gyro coordinate-to-control axis coordinates 
transformation matrix where i,j = i to 3(DBC) 

THETA x = roll error (rad) 

THETAy = pitch error (rad) 

THETA z = yaw error (rad) 

5. Calculate gyro rate estimate 


XNG 

x 

XNG 

y 

XNG 

z 


where 


CGR 

XNG 

x 

XNG 

y 

XNG 


B 


fg 

fg 

G 



CTG 11 GTG 12 CTG 1 3 ‘ 


D roll 

• 

CTG 2 1 CTG 22 CTG 23 

• 

D . , . 

pitch 


CTG 3l CTG 32 CTG 33 


D 

yaw 


G x - A £g’ G x + B £g’ XNG z 
G y = A £g* G y + B fg’ XHG y 

G z - A fg ’ G 2 + B fg* X1,G z 

gyro rate scale factor (rad/sec/count) (DBC) 

unfiltered roll rate (rad/sec) 

unfiltered pitch rate (rad/sec) 

unfiltered yaw rate (rad/sec) 

rate filter constant (DBC) 

rate filter gain (DBC) 

roll rate (rad/sec) 
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G = pitch rate (rad/sec) 

y 

G = yaw rate (rad/sec) 
z 

6. Determine gyro count reference (G ref ) 

This section sets the value of G r0f in the following 
ditions : 

• Initialization of reaction wheel control 

• Initialization of thruster control 

• initialization of a attitude hold mode 

• Spacecraft going into shadow (no Sun) 

• Spacecraft leaving roll scan mode 

The code required to implement the G ref computation 
below. The determination of SUMU(i) where i=l to 6 
scribed on the next page. 

ISET=0 

If (INITW.OR. INITT) = 1 
I SET = 1 

End if 

If (OLD I AH = O.AND.IAH) = 1 
I SET = 1 

Endif 

If (OLDIECL = O.AND.IECL = 1 .AND . I AH =0) 

I SET = 1 

Endif 

If (OLD I SCAN = 1 .AND . I SCAN = 0) 

I SET = 1 

Endif 
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con- 


is shown 
is de- 



OLDIAH = I AH 
OLDIECL = IECL 
OLD I SCAN = I SCAN 

If I SET = 1 

Do for i = 1 to 6 

GREF(i) = SUMU(i) 

Enddo 

End if 

where ISET = flag to set GREF 

OLDIAH = past value of I AH 
OLDISCAN = past value of ISCAN 
OLDIECL = past value of IECL 

To determine SUMU, SUM must be converted to a 24-bit binary 
number. Bits 1 through 3 and 20 through 24 must be set to 
0. This is then converted to a decimal number and its value 
is SUMU(i), where i=l to 6. The following routine is used 
to accomplish this task: 

Do 2000 i=l, 6 
SUMUP=SUM(i) 

Do 1000 j =1, 24 
IBINRY ( j ) =0 
IBIN=SUMUP/2 
RBIN=SUMUP/2 
RDIF=RBIN-REAL(IBIN) 

If (RDIF.NE.0.0) IBINRY ( j ) =1 
SUMUP=IBIN 
1000 Continue 
SUMU ( i ) =0 
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Do 3000 k=l,16 

SUMU(i)=IBINRY(k+5) *(2^ k+4 ^) + SUMU(i) 

3000 Continue 
2000 Continue 

where SUMU = 16 bits from SUM, least significant bit=32 

gyro counts 

IBINRY = binary representation of SUM 
6.1.2 COARSE SUN SENSOR DATA PROCESSING 

The CSS data processing function converts raw CSS data from 
the Truth Model into pitch and yaw angular errors between 
the spacecraft +X axis and the line of sight to the Sun. 

This function is performed every 256 msec. 

6. 1.2.1 Tnput/OutPUt 

• From the Truth Model 

CSS^ = CSS i output where i=l to 4 (rad) 

• To Attitude Error Computation 

ECS = CSS pitch axis error (rad) 

ECS = CSS yaw axis error (rad) 

CSS = CSS Sun presence flag (l=presence) 
prs 

6. 1.2.2 Algorithm 
1. Convert data 

Since the CSS data from the Truth Model are in radians, these 
data first need to be converted to counts: 

IDCS i = (CSS^^ - BCSS) /ACSS i = l to 4 

where IDCS i = CSS i output (counts) where i=l to 4 
BCSS = conversion factor (rad) (DBC) 

ACSS = conversion factor (rad/count) (DBC) 

Although the conversion from radians to counts and back to 
radians (step 2. a) seems superfluous, it is specified here 
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and in the other sensors as well, to model the round-off 
errors introduced by the ACE hardware and to permit the use 
of the same conversion coefficients used by the ACE. 

2. Calculate pitch and yaw errors 

The nomenclature used in the following step, defined in Ref- 
erence 14, is confusing at best. It is reproduced here as 
specified to avoid further confusion, but with added comment 
to clarify its meaning. 

a. Conversion of counts to radians 

sc 1 = idcs 2 - idcs 4 

SC 2 = IDCS 1 - IDCS 3 

Compute yaw component of Sun vector: 

SC y = (SC 1 + SC 2 ) • CSF 
Compute pitch componet of Sun vector: 

SC z = (S^ - SC 2 ) • CSF 
where CSF = CSS scale factor (rad/count) (DBC) 

Limit SC and SC to + 1.0 radians. 

I z 

b. Calculation of yaw and pitch errors 

Yaw error: ECS Z = SC y *(l+(SCj) *(1/6 + 

(3/40) *SC£)) 

Pitch error: ECS y = -SC Z * (l+(sc£) *(1/6 + 

(3/40)*SC^)) 

c. Sun presence test 

CSS = l 

prs 

css t = idcs 1 + idcs 2 + idcs 3 + idcs 4 

If (CSS .It. CTHRSH) CSS = 0 
t prs 

where CTHRSH = CSS Sun presence threshold (counts) (DBC) 

CSS fc = sum of CSS output 
CSS prs = CSS Sun presence flag (l=presence) 
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6.1.3 FINE SUN SENSOR DATA PROCESSING 

In the backup modes under control of the ACE, the FSS data 
are used to calculate an angular yaw and pitch error between 
the spacecraft +X axis and the line of sight to the Sun. FSS 
2 is the default head. If a mode changes, the default head 
is reset to 2. This function is performed every 256 msec. 


6.1.3. 1 T nout/OutPUt 






From the Truth Model 

FSS a = raw alpha angle (rad) 

FSSjj = raw beta angle (rad) 

FSS = FSS Sun presence indicator (l=Sun presence) 
pr s 

From Ground 

HN = FSS head number (default is head 2) 


To Attitude Error Computation 

EFS = FSS pitch axis error (rad) 

EFS = FSS yaw axis error (rad) 
z m 

FSS = FSS Sun presence indicator 
prs 

To Thruster Control 


FSS = FSS Sun presence indicator 
prs 

6. 1.3. 2 Algorithm 
1. Convert to counts 

FSS data for the proper head (HN) are chosen. Since the data 
from the Truth Model are in radians, these data must be con- 
verted to counts from the FSS: 


N ac " (FSS a ' B fss >/A fss 

N bc * < FSS b - B £ss> /A fss 

N = alpha angle (counts) 
a c 

N, = beta angle (counts) 
be 
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FSS a - uncalibrated alpha angle from Truth Model 
(rad) 

FSS b = uncalibrated beta angle from Truth Model 
(rad) 


B f SS = conversion factor (rad) (DBC) 

A f SS = conversion factor (rad/count) (DBC) 
2. Perform data compensation 


The alpha and beta angles in the FSS head coordinates must 
be computed using the sensor data (N gc and N b< J and com- 
pensated for known calibration errors as follows: 


a. Convertion to counts 


X 1 ’ AF 11 + af 12 - N ac 

Y 1 * AF 21 + AF 22 ' N bc 
b. Calibration 


where 


*2 - - (x})/3 


y 2 - Y 1 - < Y J>/3 

A = AF , n + x„ 


19 

B = AF 29 ♦ y 


~ alpha angle conversion factor (rad) (DBC) 

AF 12 = a ^P^ a angle conversion factor (rad/count) (DBC) 
a ^21 = ^sta angle conversion factor (rad) (DBC) 

AF 22 = t3eta angle conversion factor (rad/count) (DBC) 
AF 19 = alpha angle calibration factor (rad) (DBC) 
a ^29 = ^eta angle calibration factor (rad) (DBC) 


Pitch and yaw attitude error computation 


EFS = -B + FSYB 
EFS z = A 

where EFS^, = pitch error (rad) 

EFS z = yaw error (rad) 
f SYB 2 = FSS head 2 pitch bias (rad) (DBC) 
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6.1.4 REACTION WHEEL MOMENTUM COMPUTATION 

The reaction wheel momentum computation function derives the 
stored reaction wheel angular momentum by processing the 
data from each of the four tachometers. This function is 
performed every 256 msec. 

6. 1.4.1 Tnput/OutPUt 

• From the Truth Model 

WHL . = cumulative wheel position (rad) where i=l 
to 4 

AOWHL^ = cumulative wheel position in previous 
cycle (rad) where i=l to 4 

• To Magnetic Control Law 

HW. = reaction wheel stored angular momentum 
(ft-lbf-sec) where i=l to 4 

• To Reaction Wheel Command Processing 

HW. = reaction wheel stored angular momentum 
(ft-lbf-sec) where i=l to 4 

• At Initialization 

WHLP^ = WHL^^ where i = l to 4 
6. 1.4. 2 Algorithm 

1. Convert Truth Model data to counts 

KWHL . = (WHL.-BRW )/ARW 

1 1 a a 

KWHLP^ = (WHLP i -BRW a )/ARW a 
i=l to 4 

where BRW a = conversion factor (rad) (DBC) 

ARW = conversion factor (rad/count) (DBC) 
a 
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2. Calculate count difference 

The old cumulative count is subtracted from the present cu- 
mulative count to find count change: 

NW i = KWHL i - KWHLP i i=l to 4 

The new cumulative count is assigned to the past cumulative 
count . 

WHLP i = WHL i i=l to 4 

3. Compute stored reaction wheel angular momentum 

HW i = CWS i • NVT i=l to 4 

where CWSi = tachometer momentum conversion factor 
( ft- lbf -sec/count ) (DBC) i=l to 4 

6.1.5 THREE-AXIS MAGNETOMETER DATA PROCESSING 

This function receives data from one of two TAMs and calcu- 
lates the value of the Earth's magnetic field at the loca- 
tion of the TAM compensating for magnetic effects of the 
spacecraft. This function is performed every 256 msec. 

6-1*5. 1 Input/Output 

• From the Truth Model 

TAM.. = TAM data for each magnetometer where 

i=magnetometer (1,2) and j=l to 3 (x,y,z 
components of the magnetic field) (tesla) 

• To Reaction Wheel Control 

BE y = Earth magnetic field along spacecraft Y-axis 
(gauss) 

BE z = Earth magnetic field along spacecraft Z-axis 
(gauss) 

• To Magnetic Control Law 

BE X = Earth magnetic field along spacecraft X-axis 
(gauss) 
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BE = Earth magnetic field along spacecraft Y-axis 

y 

(gauss) 

BE = Earth magnetic field along spacecraft Z-axis 
z 

(gauss) 

• To Thruster Control 

BE = Earth magnetic field along spacecraft Y-axis 
(gauss) 

BE = Earth magnetic field along spacecraft Z-axis 
z 

(gauss) 

6. 1.5. 2 Algorithm 

1. Convert data from Truth Model to counts 

ACETAMj = (TAM ix - B tam > /A tarn j =1 to 3 ' i = 1 ° r 2 (TAM 
number) 

where ACETAMj = TAM data (counts) where j=l to 3 

B, = conversion factor (tesla) (DBC) 
tarn 

A. = conversion factor (tesla/count) (DBC) 
t am 

2. Convert data to counts 

A zero offset, CBO, is subtracted from the input data 
ACETAM(j), and this difference is multiplied by the appropr 
ate scale factor (CMS): 

Bj = CMS * (ACETAMj - CBO) 

where CMS = magnetometer scale factor (gauss/count) (DBC) 
CBO = magnetometer data zero offset (counts) 

3. Calibrate data 

The magnetic field bias due to nontorquer bar elements of 
the spacecraft is added to the measured magnetic field: 


= B 

ex x 

+ 

CB xb 

= B 

ey y 

+ 

CB yb 

= B 

ez z 

+ 

CB zb 
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whsrs CB j — components of the magnetic field bias vector 
where j=l to 3 (gauss) (DBC) 

The maximum magnitude of the magnetic field vector is 
0.9 gauss. 

6.2 ATTITUDE ERROR COMPUTATIONS 

The attitude error computation function generates three-axis 
attitude error signals and three-axis angular rate signals 
for the reaction wheel control function and thruster control 
function. The attitude errors and rates can be determined 
by the gyros, FSS, and CSS depending on the attitude hold 
flag ( I AH) and the eclipse flag (IECL). This function is 
performed every 256 msec. 

6.2.1 INPUT/OUTPUT 

• From Computational Scheduling 

IAH = attitude hold flag 

CONTROL = control mode flag 

INIT t = initialize thruster control flag 

INIT w = initialize wheel control flag 

• From Gyro Data Processing 

G x = gyro roll rate 

G y = gyro pitch rate 

G_ = gyro yaw rate 

THETA x = gyro attitude roll error 

THETAy = gyro attitude pitch error 

THETA = gyro attitude yaw error 

• From Coarse Sun Sensor Data Processing 

ECSy = CSS pitch axis attitude error 
ECS z = CSS yaw axis attitude error 
CSS prs = CSS Sun presence flag 
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• From Fine Sun Sensor Data Processing 

EFS = FSS pitch axis attitude error 

EFS = FSS yaw axis attitude error 
z 

• To Gyro Data Processing 

IECL = eclipse flag (1 = eclipse) 

• To Reaction Wheel Control 

= compensated roll rate 

W = compensated pitch rate 

W = compensated yaw rate 
z ^ 

E = roll axis attitude pointing error 
x 

E = pitch axis attitude pointing error 

E = yaw axis attitude pointing error 
z 

• To Thruster Control 

W x = compensated roll rate 

W y = compensated pitch rate 

W = compensated yaw rate 
z 

E = roll axis attitude pointing error 
x 

E = pitch axis attitude pointing error 

E = yaw axis attitude pointing error 
z 

IECL = eclipse flag 

• To Reaction Wheel Command Processing 
IECL = eclipse flag (1 = eclipse) 

6.2.2 ALGORITHM 

1. Set eclipse flag. If the Sun is present in at least one 
of the Sun sensors, the IECL flag is set to 0. Otherwise, 
it is set to 1. 

IECL=1 

If(CSS prs = 1 or (FSS prs = 1 and IFSF=0)) 
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IECL = 0 


End if 

where IFSF = FSS failure flag (l=failure) (DBC) 

2. Determine pitch and yaw errors. First use the FSS- 
derived pitch and yaw attitude errors. If the FSS data are 
not available, the CSS pitch and yaw errors are used. in the 
event of no Sun in either of the Sun sensors, the eclipse 
flag is set, and the spacecraft uses pitch and yaw data from 
the gyros. If the gyros are used, the spacecraft pitch and 
yaw attitude errors are at zero, so essentially the space- 
craft is in an attitude hold condition. 

If IFSF = 0 and FSS = 1 

prs 

ES = EFS 

y y 

ES„ = EFS 
z z 

Else 

ES = ECS 

y y 

ES = ECS 
z z 

End if 

The next step is to determine the spacecraft body rates. The 
straightforward process to determine rates is to use the 
rates from the gyros. However, if a gyro channel has failed 
(and the failure flag has been set), the function derives 
the rate from the Sun sensors. If the spacecraft is also in 

eclipse, it will drift because no attitude information is 
available. 

The derived rate code for the reaction wheel modes is as 
follows : 

If CONTROL = 0 or 1 

If INIT W = 1 .OR. EXIT = 1 (Initialize filter) 

EXIT = 0 
UY=YY=ES y 
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S Y i o = S Y 9 = S Y 8 = SY 7 = SY g = S Y 5 = SY 4 =SY 3 = SY 2 =SY ^ =E Sy 

WD y = 0 

UZ=ZZ=ES z 

SZ 10 =SZ9=SZ 8 =SZ7=SZ 6 =SZ5=SZ4=SZ3=SZ2=SZi=ES z 

WD Z = 0 

P "I CD 

(Pitch filter) 

YY = AFSR*YY + BFSR*(UY + ES y ) 

UY = ESy 

WD y = -(YY - SY 10 )/TSio 
LIMIT WDy TO +DRLIM 
SY 10 = SYg 
SYg = SYq 

sy 8 = sy 7 
sy 7 = sy 6 
sy 6 = sy 5 
sy 5 = sy 4 
sy 4 = sy 3 
sy 3 = sy 2 

SYo = SYi 
SY]_ = YY 
(Yaw filter) 

ZZ = AFSR**ZZ + BFSR* (UZ + ES Z ) 

UZ = ES Z 

WD Z = -(ZZ - SZi 0 )/TSio 

LIMIT WD Z TO +DRLIM 

SZ 10 = SZg 

SZg = SZ 8 

SZ 8 = SZ 7 

SZ 7 = SZg 

SZg = SZ5 

SZ5 = sz 4 

sz 4 — sz 3 

sz 3 = sz 2 

SZ 2 = SZx 
SZ! = ZZ 
End if 


End if 
Syinbo 1 


Definition 


Ranae 

UY,UZ 

Pointing 

error saved 

+ 1.7 

rad 

YY, ZZ 

Filtered 

pointing error 

±1.7 

rad 

SY 1-10 

Previous 

values of YY 

±1.7 

rad 

SZ 1-10 

Previous 

values of ZZ 

±1.7 

rad 

WD , WD 

Derived 

rates (pitch and yaw) 

+0.0155 rad/sec 

y z 
TS 10 

10 cycle 

times 

2.56 

sec 
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aynibQ 1 _ 

Definition 



Panrro 

AFSR 

Filter constant for derived 
rate for RW control = 1-2 
BFSR 

0 

• 7 

JA uHh y 

to 1.0 n.d. 

BFSR 

Filter gain for derived rate 
for RW control = (1 - AFSR)/2 

0 

to 

0.3 n.d. 

DRILM 

Derived rate limit 

0 

to 

0.0155 rad/sec 


The derived rate code for the thruster modes is as follows: 
If CONTROL = 2 

If = n 1 ’ 0R * EXIT = 1 (Initialize filter) 

EXIT =0 

UY=YY=ES y 

S Y 4 = S Y3 = SY 2 =SY^=ES y 
WD y =0 Y 

UZ=ZZ=ES z 

SZ 4 =SZ3=SZ2=SZ i =ES Z 
WD Z = 0 Z 

Else 

(Pitch filter) 

YY = AFSH*YY + BFSH*(UY + ES V ) 

UY = ESy y/ 

WDy = -(YY - SY 4 )/TS 4 

LIMIT WDy TO +DRLIM 

SY 4 = SY3 

SY 3 = SY 2 

SY 2 = SYi 

SYi = YY 1 

(Yaw filter) 

ZZ = AFSH*ZZ + BFSH* (UZ + ES,) 

UZ = ES Z z ' 

WD Z = -(ZZ - SZ 4 )/TS 4 
LIMIT WD Z TO +DRLIM 
SZ 4 = sz 3 
SZ3 = sz 2 
sz 2 = SZj 

sz x = YY 
End if 
End if 


Symbol 

AFSH 

BFSH 

ts 4 


D efinition Rann^ 

Filter constant = 1-2 BFSH 0.0 to 1.0 n.d. 
Filter gain = (1 - AFSH)/2 0.0 to 1.0 n.d.* 
Derived rate time difference 1.024 sec 


5132 


6-20 



The attitude errors used by the control system are determined 
as follows: 


E = THETA_ 

X x 

W = -G v 

X X 

If the spacecraft has been in an attitude hold or eclipse 
since the last cycle, the gyro data are used for attitude 
rates and errors. Otherwise, the Sun sensor data are chosen. 
If the spacecraft is not in a hold or eclipse mode and there 
is a gyro channel failure, the appropriate derived rate is 
chosen . 


If ( IAH = 1 and OLD I AH = 1) or (IECL = 1 and OLDIECL 
Then 


E 

E 


y 

z 



Else 


THETA y 

THETA 

z 



If 



If 



limited to ± PLIM 
limited to ± PLIM 

1 (pitch gyro channel failure) 
-WD 

y 

1 (yaw gyro channel failure) 
-WD 

z 


Endif 


1 ) 


where IGF 2 = pitch gyro channel health flag (0 = good, 
1 = bad) (DBC) 

IGF 3 = yaw gyro channel health flag (0 = good, 

1 = bad) (DBC) 
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6.3 ACTUATOR COMMAND GENERATION 


6.3.1 THRUSTER CONTROL FUNCTION 

The thruster control function takes in attitude errors and 
rates from the attitude error computation function, processes 
them, determines which ACTs need to be fired, and sends the 

appropriate commands to the ACTs. This function is performed 
every 256 msec. 

6.3. 1.1 Input/Output 

• From Magnetometers 

BE *y = Earth magnetic field along spacecraft Y-axis 
BE z = Earth magnetic field along spacecraft Z-axis 

• From Attitude Error Computation 

= spacecraft X-axis attitude error 
E y = spacecraft Y-axis attitude error 
E z = spacecraft Z-axis attitude error 
W x = spacecraft X-axis rate 
W y = spacecraft Y-axis rate 
W z = spacecraft Z-axis rate 
IECL = eclipse flag 

• From Gyro Data Processing 

IGF^ = roll valid gyro flag 
IGF 2 = pitch valid gyro flag 
IGF 3 = yaw valid gyro flag 

• From FSS Data Processing 
ESSp rs = FSS Sun presence flag 

• From Computational Scheduling 
I AH = attitude hold flag 
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• Initialization 

MTNABL = 0 
INIT fc = 0 

WJ X = WJ y = WJ z = 0 
BM = BM = 0 

y z 

W roll = ° 

PHI = 0 

PSP X = PSP y = PSP Z = ° 

NSP X = NSP y = NSP Z = o 
WFF = WFF = 0 

y z 

6. 3. 1.2 Algorithm 

The first step is to select the proper control gains. If 
the spacecraft is in an attitude hold condition (IAH=1), the 
following gains are selected: 

CH i = CH2 i 

CPL i = CPL2 i i=l to 3 

CP i = CP2 i 

CR i = CR2 i 

AFJ = AFJ 2 

BFJ = BFJ 2 

If the spacecraft is not in an attitude hold condition 
( IAH=0 ) , the following gains are assigned: 

CH i = CHl i 

CPL i = CPLl i i=l to 3 

CP i = CPl i 

CR i = CRl i 

AFJ = AFJ 1 

BFJ = BFJ^ 

These gains are modified by ground command as needed to ac- 
commodate specific maneuvers. Table 6-1 defines all these 

DBCs . 
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Table 6-1. Thruster Control Gain Definitions 


Symbol 

Definition 



Ranae 

CH^x, y, z 

Stored constant for roll, 
pitch, and yaw hysteresis for 
IAH = .f. 

0.0 

to 

0.9 n.d. 

C H2 x,y, z 

Stored constant for roll, 
pitch, and yaw hysteresis for 
IAH = .T. 

0.0 

to 

0.9 n.d. 

CH x,y,z 

Roll, pitch, and yaw 
hysteresis 

0.0 

to 

0.9 

CPL1 x,y, z 

Stored radian constant for 
roll, pitch, and yaw position 
limit for IAH = .F. 

0.0175 

to 0.175 rad 

CPL2 Xf y, z 

Stored radian constant for 
roll, pitch, and yaw position 
limit for IAH = .T. 

0.0175 

to 0.175 rad 

CPLx , y , z 

Roll, pitch, and yaw radian 
position limit 

0.0175 

to 0.175 rad 

CP1 x,y, z 

Stored constant for roll, 
pitch, and yaw error gain 
for IAH = .F. 

0.0 

to 

50.0 1/rad 

CP2 x,y, z 

Stored constant for roll, 
pitch, and yaw error gain 
for IAH = .T. 

0.0 

to 

50.0 1/rad 

cp x,y,z 

Roll, pitch, and yaw error 
gain 

0.0 

to 

50.0 1/rad 

AFJj , BFJ^ 

Rate filter constants for 
IAH = . F . ; AFJ;l + BFJx = 1.0 

0 to 

0. 

99 n.d. 

afj 2 ,bfj 2 

Rate filter AFJ 2 + BFJ 2 = 1.0 

0 to 

0. 

99 n.d. 

AFJ, BFJ 

Rate filter AFJ + BFJ = l.o 

0 to 

0. 

99 n.d. 

CR1 x,y , z 

Stored constant for roll, 
pitch, and yaw rate gain for 
IAH = .F. 

10.0 

rad 

to 

300.0 sec/ 

C R2 x,y, z 

Stored constant for roll, 
pitch, and yaw rate gain 
for IAH = .T. 

10.0 

rad 

to 

300.0 sec/ 

CR x,y, z 

Roll, pitch, yaw rate gain 

10.0 

rad 

to 

300.0 sec/ 
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The attitude errors received from the attitude error computa 
tion function are now limited: 

For i = 1 to 3 

If (E i > CPL i ) E i = CPL i 

If (E i < -CPL i ) E i = -CPL(i) 

These limited attitude errors are then multiplied by a gam 
and become nondimensional : 

For i = 1 to 3 
SP i = CP i * E i 

Rate filtering is then performed: 

For i = 1 to 3 

WJ i = AF j • WJ i + BFj • W. 

Definitions 

where SPi = limited, scaled attitude errors where i = 1 to 
3 (nondimensional) 

WJi = filtered spacecraft rates where i = 1 to 
3 (rad/sec) 

The attitude error data from the Sun sensors is combined 

with the rate data from the gyros (Sun sensors in case of 

pitch or yaw gyro channel failure), which will be fed to a 

control relay: 

S = SP, + CR1 • WJ, 

x 1 1 

S = SP 2 + CR2 • WJ 2 - WFF y 

S z = SP 3 + CR3 • WJ 3 - WFF z 

where Si = spacecraft axis control status where i = 1 to 
3 

WFF V = pitch modulator feedback signals used when 
Y pitch and/or yaw rates are derived from the 
Sun sensors 

WFF Z = yaw modulator feedback signals used when pitch 
and/or yaw rates are derived from the Sun 
sensors 


5132 


6-25 



If the roll gyro channel are bad, the following algorithm is 
implemented to control the roll rate. This is performed by 
taking the y,z mangetometer readings and determining the rate 
of change of this vector. The control law attempts to limit 
this rate of change to 0. Since the Earth's magnetic field 
vector changes at a maximum rate of 2 revolutions per orbit 
( rpo) , even if the spacecraft started with a 0 roll rate, it 
would develop up to a 2-rpo rate due to this change. The 
code and definitions are as follows: 

If ( IGF ( 1) .EQ. l) 

BM y = AFi * BMy + BFx * BE y 
BM Z = AF X * BM Z + BFj * BE Z 
OLDPHI = PHI 

MTB = SQRT (BM y * BM V + BM Z *BM Z ) 

If (MTB .GE. TBLIM) 

PHI = BMy /MTB 
Else 

PHI =0.0 
End if 

PHIDIF = PHI - OLDPHI 

PHID = PHIDIF * SIGN (BM Z )/TS 

If (PHIDIF .GT. RLIM) PHID = RLIM 

If (PHID .LT. -RLIM) PHID = -RLIM 

WROLL = AF 2 * WROLL + BF 2 * PHID 

WROLL = WROLL + DELW * TSPX 


sx = 
End if 

-WROLL * KRMAG 



Symbol 

Definition 


Ranoe 

AF 1 ,BF 1 

Magnetic field filter gains 

0 

to 1 n.d. 

af 2 , bf 2 

Derived rate filter gains 

0 

to 1 n.d. 

BEy , BE Z 

Compensated magnetic field 
components 

± 

0.9 gauss 

BMy , BM Z 

Filtered magnetic field 
components 

+ 

1 . 12 gauss 

MTB 

YZ-plane magnetic field 

0 

to 0.9 gauss 

PHI 

Angle between Z-axis and TB 

± 

1.0 rad 

PHIDIF 

PHI minus previous PHI 

± 

2.0 rad 

OLDPHI 

Previous PHI 

± 

1.0 rad 

PHID 

Derived roll ‘rate unfiltered 

± 

0.0155 rad/sec 

WROLL 

Derived roll rate filtered 

± 

0.0155 rad/sec 
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Svmbo 1 

DELW 

RLIM 

KRMAG 

TS 

TBLIM 


Definition 


Modulator gain 
Derived roll rate limit 
Rate gain 

Cycle time in seconds 

Lower limit on magnetic field 


Range 


+ 0.002 n.d. 

0 to 0.0155 rad/sec 
0 to 1000 1/sec 
0.256 sec 
0001 to 0.1 


0 

0 


+ 1 n.d. 


magnitude 

TSPX Roll axis firing direction 

The control relay computation is now performed. The output 
of this section is roll, pitch, and yaw firing requests. The 
code and definitions are as follows: 


Do For i = X,Y,Z 

If (Si>l) 

LHi ■ 1 

Else 

If (Si>l-CHi) 

If (LHi = -1) 

LHi = 0 

End if 

Else 

If (Si<-1) 

LHi=-l) 

Else 

If (Si<-l+CHi) 

If (LHi = 1) 

LHi = 0 

End if 

Else 

LHi = 0 

End if 

End if 

Endif 

End if 
Enddo 

Symbol Definition 

LH X y z Roll, pitch, and yaw firing 

request flags 


Range 

-1 or 0 or 1 n.d. 
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requests are then scheduled, and the appropriate 
commands are sent to the ACTs. The code for this section is 
as follows: 



If 

(ISTATE .EQ. 

1) GO TO 

20 





If 

(ISTATE .EQ. 

2) GO TO 

30 





If 

(LHX .NE. 0) 

ISTATE = 

l; 

GO 

TO 

50 

20 

If 

(LHY .NE. 0) 

ISTATE = 

2; 

GO 

TO 

50 

30 

If 

(LHZ .NE. 0) 

ISTATE = 

3; 

GO 

TO 

50 


If 

(LHX .NE. 0) 

ISTATE = 

l; 

GO 

TO 

50 


If 

(LHY .NE. 0) 

ISTATE = 

2; 

GO 

TO 

50 


I STATE = 0 
50 Continue 

Do for i = x,y, z/1, 2 , 3/roll , pitch, yaw 
TSPi = 0 

If (ISTATE .EQ. i) 

If (LHi .EQ. 1) 

TSPi = 1 

Set command CLLTPi = TRUE for positive 
i-axis firing 
PSPi = PSPi + 1 
Else 

TSPi = -1 

Set command CLLTNi = TRUE for negative 
i-axis firing 
NSPi = NSPi + 1 
End if 
End if 
Enddo 


Symbol 

ISTATE 

TSPi 


CLLTPi 


CLLTNi 


Definition 


Range 


Thruster state of sequential logic 

Thruster firing direction, i = 
x , y , z 

Low-level thruster firing command 
for positive rotation about axis 
i = x,y,z (roll, pitch, yaw) 

Low-level thruster firing command 
for negative rotation about axis 
i = x,y,z (R, P, Y) 


0 , 1 , 2 , 3 n . d , 
0 , + 1 n . d . 

True of False 
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The last section of thruster command is the derived rate 
modulator. This is only used when the spacecraft is denv 
ing pitch and/or yaw rates from the CSSs provided the rate 

is greater than MODRL. 


For i = 2 to 3 % 

If (IGFi = 0 or IECL = 1 or ABS( < MODRL) or 

FSSPRS = 1) then 
WFFi =0.0 
E 1 S 6 

WFFi = AFFi • WFFi + BFF i • TSPi 
limit WFFi to ± WFFLIM 
End if 


where MODRL 
AFFi 
BFFi 
WFFLIM 


modulator rate limit (rad/sec) (DBC) 
rate modulator constant i=2 to 3 (DBC) 
rate modulator gain i=2 to 3 (DBC) 
modulator output limit (DBC) 


6.3.2 REACTION WHEEL CONTROL FUNCTION 

The reaction wheel control function processes input from the 
attitude error computation function to generate spacecraft 
body control torques for the reaction wheels. All error and 
rate signals are limited before control law computation 
proper, from which spacecraft control torques are developed 
and then filtered and limited for output to the reaction 
wheel command processing function. If the roll scan flag 
(ISCAN) or the X-axis gyro failure flag (1GF(1)=1) is set, 
an alternate roll control law is executed. This function is 
performed every 256 msec. 


6.3.2. 1 Tnput/OutPUt 

• From Computational Scheduling 
ISCAN = roll scan flag 

INIT = reaction wheel initialization flag 
w 

• From the Magnetometer Data Processing 

BE = Earth magnetic field along spacecraft Y-axis 

BE = Earth magnetic field along spacecraft Z-axis 
z 
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From Attitude Error Computation 


W x = compensated roll rate 
W y = compensated pitch rate 
W z = compensated yaw rate 
E x = roll axis pointing error 
E y = pitch axis pointing error 
E z = yaw axis pointing error 

• To Magnetic Control 

MTNABL = magnetic torquer enable flag 

• To Reaction Wheel Command Processing 

T x = r oH axis control torque (ft-lbf) 

T y = Pitch axis control torque (ft-lbf) 

T z = yaw axis control torque (ft-lbf) 
I cage = reaction wheel cage flag 
6. 3. 2. 2 Algorithm 

The following variables are set during initialization: 

If INIT = l 
w 

INIT = 0 
w 

I =1 
cage 

HCW^ =o i = l to 4 


Q i = 0 
EP. = 0 


i = x,y,z 
i = x,y,z 


End if 


The attitude errors and rate signals are limited before they 
are inserted into the reaction wheel control law. 

For i=x, y , z 

If ABS (E^ ) > ELIM i 

EC^ = ELIM^ • sign(E^) 

Else 
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End if 



If ABS(W i ) > WLIM 

VT = WLIM * sign^) 

End if 

where ELIMi = attitude error limits where i=x,y,z (rad) 

(DBC) 

WLIM = rate limit (rad/sec) (DBC) 

The error signals are then integrated and limited. 


For i=x,y,z 

Q. = Q. + (EC. + EP.) • TS2 
If ABS(Q i ) > QLIM i 

Q i = QLIM i • sign (Q i ) 

End if 


where 


Q i 

TS„ 


QLIM, 



integrated errors where i=x,y,z (rad/sec) 
half of the sample period (sec) 
integrated error limits (rad/sec) (DBC) 
past values of EC i where i=x,y,z (rad) 
limited error signal where i=x,y/Z (rad) 


The control torque computations for all three axes are then 
performed : 


For i=x,y,z 

TEMP^ = KP^ • EC^ + KW^ • W^ + KQ^ • Q ^ 

e KP. = error gains where i=x,y,z (ft-lbf/rad) (DBC) 

KW. = rate gains where i=x,y,z ( ft-lbf /rad/sec) (DBC) 

KQi = integrated error gains where i=X/y,z (ft-lbf/ 
rad-sec) (DBC) 

TEMP. = Control torques where i=x,y,z (ft-lbf) 
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If the spacecraft is performing a roll scan (ISCAN=1), the 
following control law is used: 

If ISCAN=1 

TEMP x = KWW * (WXSTAR + W x ) 

End if 

where KWW = roll scan roll rate gain (ft-lbf /rad/sec) 

(DBC) 

WXSTAR = roll scan rate command (rad/sec) (DBC) 

In the case of bad gyro data (IGF(1)=1), the reaction wheel 
control function turns to control law, which limits the roll 
rate by controlling the rate of change of the measured mag- 
netic field vector projected onto the spacecraft Y-Z plane. 
The maximum roll rate allowed by the control law is 0.3 deg/ 
sec. The backup roll control law code and definitions for 
the various constants are as follows: 

if ( IGF ( l) .EQ. l) Then 

If (ABS(Ey) < ETHR .AND. ABS(EZ)<ETHR) Then 
TB = SQRT ( BEy • BE V + BE Z • BE„) 

IF(TB .GE. TBLIM) Then 
ER = BE V /TB 
Else 

ER = 0.0 
End if 
BP = B 

B = ABF • BP + BBF • ER 
DELTB = (B-BP) • SIGN(BE Z ) 

If (ABS( DELTB) .GT. SRLIM) 

DELTB = SRLIM • SIGN (DELTB) 

End if 

Y1 = B • PGA IN + DELTB • RGAIN 
I f (ABS ( Y1 ) .GT. XTLIM) 

Y1 = XTLIM • SIGN(Yl) 

End if 

TEMP X = -Y1 
Else 

TEMP X = 0 
End if 
End if 
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Symbol Definition 


XTLIM 

Roll control torque limit 

0 to +0.625 ft-lbf 

TBLIM 

Lower limit on magnetic field 
magnitude 

0.0001 to 0.1 gauss 

TB 

Magnetic field magnitude 

+0.9 gauss 

ER 

Normalized magnetic field in 
Y-direction 

+1 .0 n.d. 

B 

Pseudo position signal 

+1. rad 

BP 

Past value of B 

+1. rad 

ABF 

Filter constant 

+1 . n.d. 

BBF 

Filter constant 

+1 . n.d. 

DELTB 

Pseudo rate signal 

+0.04 rad/sec 

SRLIM 

Rate limit value 

0 to 0.0155 rad/sec 

Y1 

Unlimited control torque 

+0.625 ft-lbf 

PGA IN 

Position gain 

+1 ft-lbf/rad 

RGAIN 

Rate gain 

+300 f t-lbf/rad/sec 

IGF (1) 

Roll gyro data quality flag 
(l=bad, 0=good) 

(DBC) 

The control torque limiting and filtering 

code is as follows: 


Do For i = x, y, z 

If ABS(TEMPi) > TLIM 

TEMPi = TLIM • sign(TEMPi) 

End if 

UTPi = UTi 
UTi = TEMPi 
ATP* = ATt 

ATi 1 = AF • ATPi + BF • (UTi + UTPi) 
TP * = T * 

Ti X = AF*TPi + BF(ATi + ATPi) 

Enddo 


Svmbo 1 


AF 

BF 

UT 

y / z 

UTP 

y,z 

T 

x,y, z 


Def inition 

Filter constant = 1.0 - 2 BF 
Filter constant = (1.0 - AF)/2 
Buffered value of TEMP 

I * * 

Past value of UT 

9 J / 

Control torques 


Range 

0.7 to 1.0 n . d . 
0.0 to 0.3 n.d. 
+0.7 ft-lbf 
+0.7 ft-lbf 
+0.5 ft-lbf 
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Symbol 


Definition 


Range 


ATP x,y,z Past values of AT X/ y /Z ±0.5 f t-lbf 

TLIM Control torque limit 0 to 0.625 ft- 

lbf 

The last function of the reaction wheel control law is to 
enable/disable momentum unloading. If the pitch and yaw 
attitude errors are not excessive (<ETHR) , the momentum un- 
loading function is enabled; otherwise, this function is dis- 
abled. The Sun-pointing error threshold data base constant, 
ETHR, is currently set to 5 deg. This value ensures that no 
momentum unloading is performed during Sun acquisition maneu- 
vers or when there is excessive pointing error. The code for 
this section is as follows: 


If ABS ( Ey < ETHR .AND. ABS(E^) < ETHR 
MTNABL = 1 2 

Else 

MTNABL = 0 
End if 


Symbol Definition 

ETHR Sun-pointing error threshold 

6.3.3 REACTION WHEEL COMMAND PROCESSING 


Range 

0.00 to 0.20 rad 


The reaction wheel command processing function computes in- 
dividual reaction wheel motor torquer commands from the 
spacecraft control torques determined in the reaction wheel 
control function. In addition, this function provides reac- 
tion wheel caging commands during eclipse portions of the 
orbit if pitch or yaw axis gyro failure has been indicated by 
ground command. This function is performed every 256 msec. 

6.3.3. 1 Input/Output 

• From Computational Scheduling 

IAH = attitude hold flag (l=attitude hold) 
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• From Attitude Error Computation 

IECL = eclipse flag (l=eclipse) 

• From Reaction Wheel Momentum Computation 

HW. = reaction wheel angular momentum where 
i=l to 4 (ft-lbf) 

• From Reaction Wheel Control 

T = roll axis control torque 
x 

T = pitch axis control torque 

y 

X = yaw axis control torque 

ICAGE = reaction wheel cage flag (l=cage) 

• To Truth Model 

COM. = reaction wheel command where i=l to 4 
(ft-lbf) 

6 . 3. 3. 2 Algorithm 

The first step is to choose between the caging logic (Sec- 
tion A) and the normal distribution logic (Section B) . If 
there is either bad pitch or yaw gyro data and either an 
eclipse or attitude hold, the caging logic is used. Other- 
wise, the normal distribution logic is used. 

If ( (IGF 2 = 1 or IGF 3 = 1 ) and (IECL = 1 or I AH = 1) 

Caging Logic (Section A) 

Else . • D \ 

Normal Distribution Logic (Section B; 

End if 

where IGF 2 = pitch axis valid gyro data flag ( 0 =good, l=bad) 
(DBC) 

IGF 3 = yaw axis valid gyro data flag (0=good, l=bad) 
(DBC) 

6 . 3. 3. 2.1 Section A - Caging Logic 

Magnetic torquer commands are disabled when the reaction 
wheels are caged. The first time through, the caging logic 
sets the individual reaction wheel control momenta, while 
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subsequent passes compute reaction wheel control torques to 
maintain constant reaction wheel momenta. This logic tries 
to keep the overall spacecraft momentum constant during 
eclipses and/or attitude hold conditions when the gyro data 
for the pitch and/or yaw axes are bad. 

MTNABL = 0 
If ICAGE = 1 

I CAGE = 0 

HCW. = HW. i = 1 to 4 
Endif 


TRW i = AA • (HCW i - HW i ) i = 1 to 4 
For i = 1 to 4 

If ABS (TRW.) > TRW.. 

i lim 

TRW i = TRW lim • Sign (TRW^ 
Endif 


where 


HWCi = initial values of reaction wheel momenta 
where i=l to 4 


AA - reaction wheel cage gain (1/sec) (DBC) 

TRW lim = reac tion wheel torque limit (ft-lbf) (DBC) 

6. 3. 3. 2. 2 Section B - Normal Distribution Logic 

The desired three-axis control torques are distributed to the 
four reaction wheels. Command redistribution to avoid single 
wheel saturation is then performed unless a wheel failure has 
been indicated by external commands. 


ICAGE = 1 

TRW (4x1 vector) = TR W(J (4X3 matrix) * T(3xl vector) 
If FAILW = 0 


T 6 = < HW i " HW 2 - HW 3 + HW 4 ) * C 
TRW X = TRW X - Tg T 
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TRW 2 = TRW 2 + Tg 
TRW 3 = TRW 3 + T g 
TRW 4 = TRW 4 - Tg 

End if 

where FAILW = reaction wheel failure flag (=failed wheel 

number or 0) 

Cx = Redistribution constant (1/sec) 

TRWi = reaction wheel command torques where. i = 1 
to 4 (ft-lbf) 

t S Torque adjustment factor (ft-lbf) 

5 

TRWh - (4x3 matrix) = reaction wheel 

distribution matrix (see Table 6-2 for values) 

6.3.3 .2.3 Section C 

Once Section A or B is finished, the command torque for each 
reaction wheel (TRW i ) is scaled due to reaction wheel fric- 
tion, and the commands in counts to each reaction wheel are 
determined. 

COM. = (TRW^ + TEX^ • sign (HV^)) • CONV i=l to 4 

These commands are then set to zero if the respective reac- 
tion wheel has failed and the values are limited. 

For i=l to 4 
If FAILW = i 
COM i =0 

Else 

Limit COMj^ to ± 2047 counts 
End if 

where TEXi = reaction wheel friction parameters where 
i=l to 4 (ft-lbf) 

CONV = f oot-pound-to-count conversions (counts/f t-lbf ) 
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Table 6-2. Values for Scaling the Components of TRW d 


TRW d 

TRW d (l,l) 

TRW d (1,2) 

TRW d (l,3) 

TRW d (2,l) 

TRW d <2,2) 

TRW d (2,3) 

TRW d (3,l) 

TRW d (3,2) 

TRW d (3,3) 

TRW d (4,l) 

TRW d (4,2) 

TRW d (4,3) 


No Wheel 
Disabled 

= -0.5157 
= +0.4042 
= -0.4042 
= -0.5157 
= -0.4042 
» -0.4042 
= -0.5157 
= +0.4042 
= +0.4042 
= -0.5157 
= -0.4042 
= +0.4042 


Wheel 1 
Disabled 

0 

0 

0 

-1.031 

0 

-0.8085 
-1.031 
+ 0.8085 
0 
0 

-0.8085 

+0.8085 


Wheel 2 
Disabled 

-1.031 

0 

-0.8085 

0 

0 

0 

0 

+0.80850 

+0.8085 

-1.031 

-0.8085 

0 


Wheel 3 
Disabled 

-1.031 

+0.8085 

0 

0 

-0.8085 

-0.8085 

0 

0 

0 

-1.031 

0 

+0.8085 


NOTE: The ACE/CPE does not set TRW^. TRW d comes 

the default ACE/CPE PROM (programmable read 
memory) value or the OBC. 


Wheel 4 
Disabled 

0 

+0.8085 

-0.8085 

-1.031 

-0.8085 

0 

-1.031 

0 

+0 . 8085 
0 
0 
0 


from eithe 
-only 


5132 


6-38 



This section takes the commands in counts, converts them to 
newton-meters, and ships the commanded torque values (COM i 
where i-1 to 4) for each reaction wheel to the Truth Model. 

COM i = 1.3558179 • (COMVCONV) i = l to 4 

6.3.4 MAGNETIC CONTROL LAW 

The magnetic control law function performs the computations 
required to unload momentum stored in the reaction wheels. 
The actual unloading of the momentum is performed by sending 
the appropriate commands to the magnetic torquers, which in- 
teract with the Earth’s magnetic field to produce a control 
torque. This function is performed every 512 msec. 

6. 3. 4.1 Tnput/OutPUt 

• From Reaction Wheel Momentum Computation 

HW . = wheel i stored angular momentum (ft— lbf— sec) 
wheel where i=l to 4 

• From Magnetometer Data Processing 

BE = Earth magnetic field along spacecraft X-axis 
x 

(gauss) 

BE = Earth magnetic field along spacecraft Y-axis 
(gauss) 

BE = Earth magnetic field along spacecraft Z-axis 
z 

(gauss) 

• From Reaction Wheel Control 

MTN , = magnetic torquer command enable 
abl 

• To Torquer Bars 

MTORQ i = commanded magnetic moment for torquer i 
(counts) where i=l to 3 
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6 . 3. 4 . 2 Algorithm 


If a particular wheel has been flagged as failed, the angula 
momentum for that wheel is set to 0: 

For i=l to 4 
If(FAILW. = 1) HW.=0 

The angular momentum to be dumped is the angular momentum of 
all four reaction wheels projected onto the three body axes. 
Figure 6-1 shows the reaction wheel assembly configuration. 
From this figure, the reaction wheel axes for each wheel can 
be determined in body coordinates as follows: 

= (CCBETA, — CSBETA*CCALPHA, CSBETA*CSALPHA) 

^2 = (CCBETA, CSBETA*CSALPHA, CSBETA*CCALPHA) 

^3 = (CCBETA, — CSBETA*CSALPHA, — CSBETA*CCALPHA) 

= (CCBETA, CSBETA*CCALPHA, — CSBETA*CSALPHA) 

Assuming that each reaction wheel has angular momentum HW. 
(i=l to 4) with the appropriate sign designating the direc- 
tion of the spin (+/-), the angular momentum about each body 
axis is as follows: 

H 1 = + HW 2 + HW 3 + HW 4 ) * CCBETA 

H 2 = ~ ^JJ^CCALPHA + (HW 2 - HW )*CSALPHA) 

*CSBETA 

H 3 = < (HW 1 - HW 4 ))*CSALPHA + (HW 2 - HW3 ) *CCALPHA) 

*CSBETA 

The momentum is then converted from foot-pound-force-seconds 
to newton-meters: 

For i=l to 3 
HD i = * 1.35582 
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To determine the magnetic moment the spacecraft must develop 

to dump the reaction wheel momentum, the following equations 
must be examined: 

T = mx~B 
t“ = d iT / dt 

where T = torque vector 

m = magnetic moment vector 

B = magnetic field vector 

H = angular momentum of the spacecraft 

It should be noted that H is in the same direction as T and 
the vector parallel to the magnetic moment vector (m* ) is 
found by taking the following cross product: 

M ' = If x HD 

where M' is in the same direction as iT. 

Once «• has been calculated, the vector is transformed from 
body coordinates to torquer bar coordinates (see Figure 6-2) : 


MTC^ 


amb^ AMB 4 amb ? 


M i'" 

mtc 2 

= 

AMB 2 AMB 5 AMBq 


V 

MTC 3_ 


AMB 3 AMBg AMB g 


V 

b. _ 


The vector MTCj (i-1 to 3) is now converted to counts that 
will be sent to the torquer bars, and MTCj is compared 
against the maximum allowable torquer command and limited if 
necessary. The minus creates a magnetic moment vector that 
reacting with the Earth's magnetic field, will create a 

torque to decrease the excess angular momentum created by 
the reaction wheels. 

For i=l to 3 
If (ABS(MTC^) < CMAXTQ i ) 

MTORQ. = -CM • MTC . 

1 l 

MTORQ i = MTORQ. • CTDE. 
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SECTION A-A 



Figure 6-2. 


Magnetic Torquer Location and Orientation 




Else 

MOTRQ^ = - (CMD • sign(MTC-)) 

Endif 

If the momentum unloading function is disabled, the commands 
to the torquer bars are set to 0. 

If (MTNABL = 0) 

MTORQi=0 i=l to 3 
Endif 

Definitions 

AMB ( 1 - 9 ) = transformation from body coordinates to magnetic 
torquer coordinates (DBC) 

CTDE(l-3) = magnetic torquer scale factor (counts/A-m^) 

(DBC) 

CM = cross-product control law gain (1/sec— gauss— tesla) 

(DBC) 

CMD = magnetic torquer command limit (counts) (DBC) 

CMAXTQ( 1-3 ) = CMD/ (CTDE ( 1-3 ) * CM) (N-m-gauss-sec) (DBC) 
CCALPHA, CCBETA, CSALPHA, CSBETA = (DBC) 

6.4 ACE CQNTROT. 

6.4.1 OBC/ACE TRANSITIONS 

When a transition occurs from the OBC to the ACE, the OBC 
passes the status parameters to the ACE and continues to 
perform sensor processing. These parameters are not handed 
over in the case of an OBC failure, in which case the ACE 
uses default values for these parameters^ The actual con- 
trol in this condition resides in the ACE, which does its 
own sensor processing and sends commands to the actuators. 

The main parameters handed over by the OBC are the gyro and 
reaction wheel status flags. The OBC has control in only 
one area: transitions between the SRPM to the SHM due to 
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loss of the Sun or failure to acquire the Sun. The OBC has 
a timer that starts up whenever the Sun signal from the FSS 
Sun presence sensor is lost. The Sun lost counter limit is 
a value that can be changed from the ground. If the counter 
exceeds the counter limit, the OBC directs the ACE to tran- 
sition from the SRPM to the SHM, and Sun acquisition is 
tried in this mode. Table 6-3 lists the initial values of 
the various DBCs used in the ACE and those used to direct 
the IRU to use high-rate mode and to select FSS head 2 data. 

The power-on initialization function is defined by the 
following algorithm: 

Clear RAM from locations 21 to 7FF (hex) inclusive 
Initialize all RAM variables identified in Table 6-3 
Select IRU high-rate mode 
Select FSSA head 2 

6.4.2 COMPUTATIONAL SCHEDULING 

The various ACE control processing electronics (ACE/CPE) 
sensor and actuator functions are called by this portion of 
the firmware. The cycle time is 128 msec. 

6. 4. 2.1 Tnout/OutPUt 

• To Computational Scheduler From Ground or OBC 


BMC (1-5) = firmware mode from ground 
= 1, Sun reference pointing 
= 2, reaction wheel attitude hold 
= 3, reaction wheel roll scan 
= 4, safe hold mode 
= 5, thruster attitude hold 


ILATCH (1-2) = actuator control flag from OBC 
= 0, reaction wheel control when 
spacecraft was on OBC 

= 1, thruster control when spacecraft 
was on OBC 
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Table 6-3. RAM Variables To Be Initialized During 
Power-On Initialization (1 of 4) 


Name 

_ DBC Group Definition 

Value 


SPT 

Solar Panel Timer 

3056 


CBIAS 

Gyro Data Processing 

0 for all elements 

CNBIAS(i) 

Gyro Data Processing 

255 for all elements 

IGF 

Gyro Data Processing 

0, 0 , 0 , 1 , o. 

0 

CTG 

Gyro Data Processing 

3x3 identify 

matrix 

CGP 

Gyro Data Processing 

7.75 x 10 -6 


CGR 

Gyro Data Processing 

3.03 x 10 -5 


AFG 

Gyro Data Processing 

0.7132 


BFG 

Gyro Data Processing 

0.2868 


CSF 

CSS Data Processing 

2.1379 x 10 -4 


CTHRESH 

CSS Data Processing 

240 


AF11 

FSS Data Processing 

-0.62487 


AF21 

FSS Data Processing 

-0.62487 


AF12 

FSS Data Processing 

0.7628 E-4 


AF22 

FSS Data Processing 

0.7628 E-4 


AF19 

FSS Data Processing 

0 


AF29 

FSS Data Processing 

0 


FSYB2 

FSS Data Processing 

0.03491 


CWS 

Reaction Wheel 
Momentum Computation 

0.260408 


CMS 

Magnetometer Data 
Processing 

-3.315 x 10~ 4 


CBO 

Magnetometer Data 
Processing 

0 


CBXB , 
CBYB, 
CBZB 

Magnetometer Data 
Processing 

0.022,0.022, 

0.022 


AFSR 

Attitude Error 
Computation 

0.8511 


BFSR 

Attitude Error 
Computation 

0.0744 


AFSH 

Attitude Error 
Computation 

0.4264 
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Table 6-3 . 


RAM Variables To Be Initialized During 
Power-On Initialization (2 of 4) 



nur r5rmio Definition 

Value 

Name 

BFSH 

Attitude Error 
Computation 


0.2868 

TS4 

Attitude Error 
Computation 


1.024 

TS10 

Attitude Error 
Computation 


2.56 

DRLIM 

Attitude Error 
Computation 


0.0155 

PLIM 

Attitude Error 
Computation 


0.254 

ELIM 

Reaction Wheel 

Control 

0.0622,0.0847,0.0894 

x,y,z 

WLIM 

Reaction Wheel 

Control 

0.00436 

AF 

Reaction Wheel 

Control 

0.9182 

ABF 

Reaction Wheel 

Control 

0.97993 

BF 

Reaction Wheel 

Control 

0.0409 

BBF 

Reaction Wheel 

Control 

0.02007 

TS2 

Reaction Wheel 

Control 

0.128 

QLIM x,y,z 
PGA IN 

Reaction Wheel 
Reaction Wheel 

Control 

Control 

0.4401,0.7800,08200 

0.01 

RGAIN 

Reaction Wheel 

Control 

125. 

SRLIM 

Reaction Wheel 

Control 

0.02 

KP_ „ , 

Reaction Wheel 

Control 

19.82,29.00,35.63 

x,y,z 
KW v „ 

Reaction Wheel 

Control 

1479.0,2164.0,2659.0 

x,y, z 
KQ 

Reaction Wheel 

Control 

0.095,0.138,0.171 

w x,y,z 

TLIM 

Reaction Wheel 

Control 

0.3646 

TBLIM 

Reaction Wheel 

Control 

0.001 

KWW 

Reaction Wheel 

Control 

1551.0 

WXSTAR 

Reaction Wheel 

Control 

0.00087 

ETHR 

Reaction Wheel 

Control 

0.087 

XTLIM 

Reaction Wheel 

Control 

0.3646 

CHI 

Thruster Control 

0.00, 0.00, 0.00 

x,y, z 
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Table 6 3. RAM Variables To Be Initialized During 
Power-On Initialization (3 of 4) 


£anse — DBC Gro up Definition Value 


CH2 

x,y,z 

Thruster Control 

0.0, 0.0, 0.0 

CPI 

x,y, z 

Thruster Control 

11.12, 11.0, 10.10 

CP2 

x,y,z 

Thruster Control 

11.12, 11.0, 10.10 

CR1 

x,y,.z 

Thruster Control 

22.06, 29.14, 85.8 

CR2 

x,y,z 

Thruster Control 

22.06, 29.14, 85.8 

CPL1 

x,y,z 

Thruster Control 

0.103, 0.101, 0.122 

CPL2 

x,y,z 

Thruster Control 

0.103, 0.101, 0.122 

AFJ 1 

Thruster Control 

0.01 

BFJ 1 

Thruster Control 

0.99 

afj 2 

Thruster Control 

0.01 

bfj 2 

Thruster Control 

0.99 

AF 1 

Thruster Control 

0.975 

BF 1 

Thruster Control 

0.025 

RLIM 

Thruster Control 

0.008 

KRMAG 

Thruster Control 

461 

AF 2 

Thruster Control 

0.994 

BF 2 

Thruster Control 

0.006 

DELW 

Thruster Control 

0.0008 

TS 

Thruster Control 

0.256 

MODRL 

Thruster Control 

0.001745 

AFF 

y 

Thruster Control 

0.9974 

BFF 

y 

Thruster Control 

0.1023 

AFF 

z 

Thruster Control 

0.9987 

BFF 

z 

Thruster Control 

0.0512 

WFFLIM 

Thruster Control 

3.0 

CM 

Magnetic Control Law 

250.0 

CCALPHA 

Magnetic Control Law 

0.70711 

CSALPHA 

Magnetic Control Law 

0.70711 

CCBETA 

Magnetic Control Law 

0.48481 

CSBETA 

Magnetic Control Law 

0.87462 
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Table 6-3. 


RAM Variables To Be Initialized During 
Power-On Initialization (4 of 4) 


Name 


AMB 


1-9 


DBC Group Definition 
Magnetic Control Law 


Value 

0.66674, 0.52701, 
0.52701, 0, 0.70711, 
-0.70711. -0.74529, 
0.47145, 0.47145 


CTDE 1,2,3 

CMD 

CMAXTQ 1 /23 
AA 


TRWLIM 

CTAU 

TPHI 

TRWD 


Magnetic Control Law 

Magnetic Control Law 

Magnetic Control Law 

Reaction Wheel Command 
Processing 

Reaction Wheel Command 
Reaction Wheel Command 
Reaction Wheel Command 
Reaction Wheel Command 


CONV 

TEX 1 ,2,3,4 
LOMEM 

HIMEM 


Reaction Wheel Command 
Reaction Wheel Command 
Reaction Wheel Command 
Reaction Wheel Command 


1.02228 

2047 

8.009 


0.3 


0.5 


0.00020825 

0 


-0.51567, 

-0.40424, 

-0.40424, 

-0.51567, 

0.40424, 

-0.40424, 

3208.556 

0.0528 

21 hex 

7FF (hex) 


0.40424, 

-0.51567, 

-0.40424, 

0.40424, 

0.51567, 

0.40424 
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• To Attitude Error Computation 

IAH = attitude hold flag (l=attitude hold) 

CONTROL = control mode flag (l=reaction wheels, 
2=ACTs) 

INIT t = initialize ACT firing (l=yes) 

INIT W = initialize reaction wheels (l=yes) 

• To Reaction Wheel Control 

ISCAN = roll scan flag (l=yes) ’ 

INIT W = initialize reaction wheels (l=yes) 

• To Thruster Control 

INIT t = initialize ACT firing (l=yes) 

IAH = attitude hold flag 

Initialization 

SLOT=0 

6. 4. 2. 2 Main Lonp 

The following is a listing of the code contained in the main 
loop of the computational scheduler: 

OLDBMC=BMC 

OLDCONTROL=CONTROL 

SLOT=SLOT+l 

If ( SLOT>4 ) SLOT=l 

Read in the mode storage register and check to see if the 
mode is recognized. If not, determine when the actuator was 

last used under the OBC and switch to the same actuator under 
the ACE/CPE. 

I f ( BMC not equal 1,2, 3, 4, or 5) Then 

f ° r 3 co,lsective c * cles > Th «n 

BMC=1 (Sun reference pointing) 

Else 

BMC =4 (safe hold) 

End if 
End if 
End if 
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Perform mode control if the mode has changed this loop. 

If (BMC not equal OLDBMC) Then 

If (BMC = 1) (Sun reference pointing mode) 

control=l 

IAH=0 

ISCAN=0 . x 

Else if (BMC = 2) (reaction wheel attitude hold mode) 

CONTROL =1 

IAH=1 

ISCAN=0 

Else i f ( BMC = 3) (roll scan mode) 

CONTROL=l 

IAH=0 

ISCAN=1 

Else i f ( BMC = 4) (safe hold mode) 

CONTROL=2 

IAH=0 

ISCAN=0 . . 

Else i f ( BMC = 5) (thruster attitude hold mode) 

CONTROL=2 
IAH= 1 
I SCAN =0 

Else (No recognized mode) 

CONTROL =0 

IAH=0 

ISCAN=0 


End if 

The following code determines whether reaction wheel or 
thruster control needs to be initiated: 

If (CONTROL = 1 and OLDCONTROL not equal 1) Then 
INIT W =1 

Disable roll thruster firings 
Disable pitch thruster firings 
Disable yaw thruster firings 

Else if (CONTROL = 2 and OLDCONTROL not equal 2) Then 
INIT t =l 

Enable roll thruster firings 
Enable pitch thruster firings 
Enable yaw thruster firings 
Issue zero commands to RWA 
Issue zero commands to MTA 
Disable commands to OATs 1-4 
Issue OAT BANK1 and BANK2 power off 
Issue load OAT pulse timer with T = 1 
End if 
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Once mode control has been performed (if needed), the sched- 
uler performs the solar array indexing for the SRPM and SHM: 

If (BMC=srpm OR BMC=shm) Then 

If ( splf .NE. 1 and sp2f .NE. 1) Then 
If ( IAH = l and OLDIAH < > 1) Then 

= sp2t = 0 ! initialize counters 

End if 

If (solar array 1 (SA1) is not indexed) Then 
Command SA1 to index 
spit = spit + 1 
If (spit > spt ) splf = l 

Else if (solar array 2 (SA2) is not indexed) Then 
Command SA2 to index 
sp2t = sp2t + 1 
If ( sp2t > spt) sp2f = 1 
IAH=1 
Else 

IAH = 0 
End if 
Else 

IAH = 0 
End if 
End if 


The sensor and external command processing is then performed: 
Call external command processing 
Call gyro data processing 

If (SLOT = 2 or SLOT = 4) Then 
Call CSS data processing 
Call FSS data processing 
Call reaction wheel momentum computation 
Else 

Call magnetometer data processing 
Endif 

Attitude error computation is now scheduled: 

If (SLOT = 2 or SLOT = 4) Then 
Call attitude error computation 
Endif 
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Actuator processing is now scheduled: 

If (C0NTR0L=1) or (CONTROL = 0 and ACSF is set) Then 
If (SLOT = 2 or SLOT = 4) Then 
Call reaction wheel control 
Call reaction wheel command processing 
Else if (SLOT=3) 

Call magnetic control law 
Endif 

Else i f ( CONTROL = 2 ) 

I f ( SLOT = 2 or SLOT = 4) 

Call thruster control 
Endif 
Endif 

6.5 ACE /CPE MODES 

6.5.1 SUN REFERENCE POINTING MODE CONTROL LAW 

The SRPM uses the reaction wheels for control, pitch, and yaw 
attitude error data from the FSS; roll error data from the 
gyros; and rate information for all axes from the gyros to 
point the +X axis at the Sun during normal operations. In 
transitioning from an OBC— controlled mode to the ACE/CPE, the 
spacecraft first determines whether the solar arrays need to 
be indexed. If this is the case, the spacecraft is first put 
into an attitude hold mode using reaction wheels for control 
and gyros for attitude error and rate data. Once the space- 
craft solar arrays are indexed, the spacecraft starts its Sun 
acquisition phase. The reaction wheels are used for control, 
the FSSs are used for pitch and yaw attitude error informa- 
tion, and the gyros are used for roll attitude error informa- 
tion and for rate information for all three axes. If the 
FSS registers no Sun, the spacecraft uses the CSSs for pitch 
and yaw attitude error information. 

The SRPM has provisions for backup operation due to various 
failures. In case of an FSS failure, the ACE/CPE uses the 
CSSs for pitch and yaw attitude error information, provided 
that ground control personnel uplink an FSS failure flag. 

If a pitch or yaw gyro channel failed while the spacecraft 
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was in an OBC-controlled mode, the ACE has the ability to 
derive pitch and yaw rates by back-differencing FSS attitude 
error data (or CSS if there are no FSS data). in the case 
of roll gyro channel failure, the reaction wheel control 
function implements a control law that limits the roll rate 
by controlling the movement of the magnetometer Y- and 
Z-axis data. The maximum roll rate allowed by this control 
law is 0.3 deg/sec. In the case of no Sun in both the FSS 
and CSS FOVs, the ACE/CPE automatically places the space- 
craft in an attitude hold mode using the gyros for attitude 
error and rate information and the reaction wheels for con- 
trol. Figures 6-3 through 6-5 outline the various control 
loops used in the SRPM (Reference 15). 

6.5.2 ROLL SCAN MODE CONTROL LAW 


The roll scan mode (RSM) uses the reaction wheels for con- 
trol, pitch and yaw error data from the FSSs, roll error 
data from the gyros, and rate information for all three axes 
from the gyros to point the + X axis at the Sun during normal 
operation. it also allows a rotation about the roll axis at 
a ground-selectable rate for star identification and atti- 
tude determination (References 15 and 16, p. 4 - 7 ). if the 

FSS registers no Sun, the spacecraft uses the CSSs for atti- 
tude error information. 


The RSM has provisions for backup operation due to various 
failures. it is assumed that ground control personnel will 
have diagnosed all problems and set the proper flags, be- 
cause this mode can only be reached by ground command. in 
the case of an FSS failure, the ACE/CPE uses the CSSs for 
attitude error information, provided that ground control 
personnel uplink an FSS failure flag. if a pitch or yaw 
gyro channel failure flag is set, the ACE has the ability to 
derive pitch and yaw rates by back-differencing FSS attitude 
error data (or CSS, if there are no FSS data). in the case 
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SRPM 


SCOT- SLOT +1 


SLOT > 4 ? 


SLOT-1 



SLOT- 
2 OR 4 ? 


H2 a- TAM PROCESSING 


SLOT-3? 



NOTE: A SLOT INTERVAL IS 1 28 MSEC. 

Figure 6-3. SRPM Control Flow 
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Figure 6-4. SRPM Attitude Error Determination 













Figure 6—5. SRPM Reaction Wheel Control 

of roll channel gyro failure, ground control personnel would 
be required to set the roll channel selection flag to the 
proper roll channel so that the spacecraft could continue 
its roll rate. In the case of no Sun in both the FSS and 
CSS FOVs, the ACE/CPE automatically places the spacecraft in 
an attitude hold mode using the gyros for attitude error and 
rate information and the reaction wheels for control. The 
roll is not affected by the attitude hold. Figures 6-6 
through 6-8 outline the various control loops for this mode. 

6.5.3 REACTION WHEEL ATTITUDE HOLD MODE 

The reaction wheel attitude hold mode (RWAHM) uses the reac- 
tion wheels for control and the gyros for attitude error and 
rate data to hold the spacecraft attitude inertially fixed. 
Backup operation in this mode is limited because it is 
assumed that ground control personnel, who must command this 
mode, will identify and correct any problems before a tran- 
sition to the RWAHM is initiated. If a roll gyro channel 
failure flag is set, the reaction wheel control function 
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NOTE: A SLOT INTERVAL IS 128 MSEC. 


Figure 6-6. RSM Control Flow 
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Figure 6-8. 


RSM Reaction Wheel Control 
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implements a control law that limits the roll rate by con- 
trolling the movement of the magnetometer Y- and Z-axis out- 
put. The minumum roll rate allowed by this control law is 
0.3 deg/sec (Reference 15, pp. 7.4-27 to 7.4-30). Fig- 
ures 6-9 through 6-11 outline the various control loops in 
the RWAHM. 

6.5.4 SAFE HOLD MODE 

The SHM uses the ACTS for control, pitch and yaw attitude 
error data from the FSS, roll error data from the gyros, and 
rate information for all axes from the gyros to point the 
+X axis at the Sun during normal operations. In transition- 
ing from an OBC-controlled mode to the ACE/CPE, the space- 
craft first determines whether the solar arrays need to be 
indexed. If this is the case, the spacecraft is first put 
into an attitude hold mode using the ACTS for control and 
the gyros for attitude error and rate data. Once the solar 
arrays are indexed, the spacecraft starts its Sun acquisi- 
tion phase. The ACTs are used for control, the FSSs are 
used for pitch and yaw attitude error data, and the gyros 
are used for roll attitude error information and for rate 
information for all three axes. If the FSS registers no 
Sun, the spacecraft uses the CSSs for pitch and yaw attitude 
error information. 

The SHM has provisions for backup operation due to various 
failures. In the case of FSS failure, the ACE/CPE uses the 
CSSs for pitch and yaw attitude error information, provided 
that ground control personnel uplink an FSS failure flag. 

If a pitch or yaw gyro channel failed while the spacecraft 
was in an OBC-controlled mode, the ACE has the ability to 
derive pitch and yaw rates by back-differencing FSS attitude 
error data (or CSS, if there are no FSS data). In the case 
of roll channel failure, the thruster control function 
implements a control law that limits the roll rate by 
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NOTE: A SLOT INTERVAL IS 1 28 MSEC. 


Figure 6-9. RWAHM Control Flow 
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Figure 6-11. 


RWAHM Reaction Wheel Control 
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controlling the movement of the magnetometer Y- and Z-axis 
data. In the case of no Sun in both the FSS and CSS fields 
of view, the ACE/CPE automatically places the spacecraft in 
an attitude hold mode using the gyros for attitude error and 
rate information and the ACTs for control. Figures 6-12 
through 6—14 outline the various control loops used in the 
SHM. 

6.5.5 THRUSTER ATTITUDE HOLD MODE 

The thruster attitude hold mode (TAHM) uses the ACTs for con- 
trol and the gyros for attitude error and rate data to hold 
the spacecraft attitude inertially fixed. Backup operation 
in this mode is limited because it is assumed that ground 
control personnel, who must command this mode, will identify 
and correct any problems before a transition to the TAHM is 
initiated. If a roll gyro channel failure flag is set, the 
thruster control function implements a control law that 
limits the roll rate by controlling the movement of the 
magnetometer Y- and Z-axis output. Figures 6-15 through 
6-17 outline the various control loops in the TAHM. 

6.5.6 CONTINGENCY ORBIT MAINTENANCE MODE 

The contingency orbit maintenance mode (COMM) provides an 
orbit adjust capability to GRO while the spacecraft is under 
control of the ACE/CPE. This mode is a modified TAHM. in 
the TAHM, the ACTs are the actuators and the gyros provide 
attitude error and rate information. When the spacecraft is 
placed into the THM, the desired attitude is determined as 
well as the three-axis rotation needed to maneuver to the 
desired attitude. Each rotation is accomplished by uplink- 
ing a single-axis gyro error corresponding to the desired 
single-axis rotation. Once the spacecraft is in the desired 
attitude, ground control personnel uplink a command to fire 
one pair of OATs. Firing durations are selectable by ground 
control personnel. The OATs are not offpulsed for attitude 
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SHM 



Figure 6-12. SHM Control Flow 
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Figure 6-16. TAHM Attitude Error Determination 



Figure 6-17 


TAHM Thruster Control 






control. The ACTs provide all attitude control, and the 
gyros continue to provide attitude rate and error informa- 
tion. A 1-rpo rate capability exists. This would be ac- 
complished by continually uplinking different GREF data base 
constants (Reference 15, pp. 7.4-4, 7.10-1 to 7.10-3). The 
different GREFs would change at a 1-rpo rate.* 

6.5.7 THRUSTER COMMAND MODE 

The thruster command mode (TCM) provides the ability to fire 
any ACT or pair of ACTs in real time by external command. 

The firings are in impulses of fixed duration, selectable by 
ground control personnel. Two pulse durations are available 
(Reference 16): 256 msec and 2048 msec. The resolution of 

the pulses will be ± 1.0 percent. Thruster commands will be 
processed and executed one at a time up to a rate that pro- 
duces continuous thruster operation. For this and higher 
command frequencies, the result will be continuous thruster 
operation, according to TRW (Reference 17, pp. 24, 25, 57 ). 

The TCM is not a mode per se but an ability to command the 
ACTs externally. 

6 • 6 MOMENTUM MANAGEMENT 

Momentum management is the process by which the spacecraft 
dumps the reaction wheel stored angular momentum while under 
control of the ACE/CPE. Momentum management is performed 
every 512 msec using data from the gyros. Sun sensors, TAMs, 
reaction wheel control function, and magnetic control law. 

The torquer bars produce a magnetic moment M that, acting 


Personal communication, 
August 1987. 


Terry Watson (TRW) at GSFC, 
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with the Earth's magnetic field, opposes the excess angular 
momentum from the reaction wheels: 

T* = M - x eT T* = d H/dt 

where T* = torque vector 

= magnetic moment vector 
r = Earth's magnetic field vector 
if = angular momentum vector (reaction wheels) 

M^ody = "B x If; M* body parallel to M 

Jbarl * [AM i ] “'body 
M bars _k M bars 

where [AMB] = transformation matrix from body to bars coord 
nates 

k = gauss-to-counts conversion factor 
M^ars = commands to the torquer bars 

Figure 6-18 illustrates the momentum management function. 
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B = EARTHS MAGNETIC FIELD 

M » MAGNETIC MOMENT VECTOR FROM TORQUER BARS 
H » REACTION WHEEL ANGULAR MOMENTUM VECTOR 
M' = INTERMEDIATE MAGNETIC MOMENT VECTOR 


Figure 6-18. Momentum Management (CPE) 
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APPENDIX A - COORDINATE SYSTEMS 


A. 1 GEOCENTRIC INERTIAL COORDINATE SYSTEM (Xg, Yq, Z G) 

The origin of the geocentric inertial (GCI) coordinate sys- 
tem is at the geocenter, with the +X X axis in the equato- 
rial plane pointed to the vernal equinox, +Z T along the 
Earth spin axis pointed North, and Yj completing the right- 
hand set. 

A. 2 ROPY REFERENCE SYSTEMS 

A. 2.1 BODY COORDINATES (X 0 , Yg, Z 0 ) 

The GRO body coordinate system (BCS) is centered on the 
center of mass of the observatory. The +Zg axis is normal 
to the plane of the trunnions and on the payload side of the 
spacecraft, the +Yg axis is parallel to the solar array 
drive axis, and the +X 0 axis completes a righthand orthog- 
onal set and is on the Sun sensor side of the vehicle. Fig- 
ure A-l illustrates the GRO BCS. 

A. 2. 2 SPACECRAFT COORDINATES (X, Y, Z) 

Spacecraft coordinates are defined with the +Z axis normal 
to the plane of the trunnions, located at the center line of 
the trunnions, and on the payload side of the observatory. 
The +Y axis is parallel to the solar array drive axis, and 
the +X axis forms a right-hand set on the Sun sensor side of 
the observatory. The center of the coordinates is at the 
intersection of the Z-axis with the plane of the trunnions. 

A. 2. 3 ACAD REFERENCE COORDINATES (X Q , Y Q , Z Q ) 

Attitude control and determination (ACAD) reference coordi- 
nates are defined by the master reference cube installed on 
the optical bench. All attitude determination and pointing 
requirements are defined in terms of, or with reference to, 
this coordinate system. The ACAD reference system is 
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GRO Spacecraft and Body Coordinate System 



approximately parallel to the spacecraft coordinate system 
(within alignment tolerances). 

A. 3 ATTI TUDE REFERENCE COORDINATE SYSTEM (X R , Yr, z r) 

The attitude reference coordinate system is defined such that 

the origin is the spacecraft center of mass. The +X R axis 

is in the orbit plane pointed in the direction of spacecraft 

orbital motion, the + Z R axis is pointed to the geocenter, 

and the +Y axis is normal to the orbit plane to complete 
R 

the righthand set. 

A . 4 REACT ION WHEEL ASSEMBLY COORDINATE SYSTEM (X RWA , Y RWA , 

z rwa) 

The reaction wheel assembly (RWA) coordinate system is de- 
picted in Figure A-2. 

A. 5 REACTI ON WHEEL COORDINATE SYSTEM (X RW , Y RW , Z RW ) 

The reaction wheel (RW) coordinate system is defined such 
that the origin is centered on a face of the pyramidal as- 
sembly, the +X RW axis is directed along the pyramidal face 
pointed toward the apex, the +Z RW axis is directed normal 
to the pyramidal face, and the +Y RW axis is defined to 
complete the righthand set. 

A. 6 MAGNETIC TORQUER COORDINATE SYSTEM (Xmt/ y MT> z MT) 


The magnetic torquer coordinate system is defined by a 2-1-3 
Euler rotation relative to spacecraft body coordinates. The 
Euler angles are defined by 0 about the +Y R axis, <J> about 
the +X R ' axis, and i|» about the + Z B " axis. Figure A-3 shows 
the Euler angle rotations. 


A. 7 TNERTIAI. REFERENCE UNIT INPUT AXES 

The inertial reference unit (IRU) input axes are aligned with 
spacecraft body coordinates. 
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A * ® FIXED HEAD STAR T R ACKER COORDINATE SYSTEMS 


Figure A-4 illustrates the FHST coordinate systems. 

A. 8.1 FHST NUMBER 1 ( FHST1 ) 

The FHST1 coordinate system is defined by the axes X y 
a nd Z T1 , with the Z T1 axis along the boresight. The +Z axis 
is in the X Q -Y B plane 45 deg from the -X 0 axis and 45 deg from 
the + Y b axis. The + Y T1 axis is in the + Z B axis direction. 

The X T1 axis completes the righthand set. 

A. 8.2 FHST NUMBER 2 ( FHST2 ) 

The FHST2 coordinate system is defined by the axes X Y 

T2 ' t 2 f 

an Z T2' the Z T2 axis along the boresight. The +Z axis 

is m the X b -Y b plane 45 deg from the -X Q axis and 45 d^g from 
the -Y b axis. The +Y T2 axis is in the -Z B axis direction. 

The X^ 2 axis completes the righthand set. 

A * 9 FIN E sun sensor coordinate systems 

Figures A-5 and A-6 illustrate the FSS coordinate systems. 

A. 9.1 FSS NUMBER 1 (FSS1) 

The FSS1 coordinate system is defined by the axes X Y 
and Z F1 , with the Z pl axis along the boresight. The +Z axis 
is in the X B -Z B plane 60 deg from the +X B axis and 30 deg from 
the + Z B axis. The + X pi axis is in the +Y B axis direction. 

The Y f1 axis completes the righthand set. 

A. 9. 2 FSS NUMBER 2 ( FSS2 ) 

The FSS2 coordinate system is defined by the axes x , y 
and Z F2' w ^ th the Z p2 axis along the boresight. The +Z axis 
is in the Xg-Zg plane 2 deg from the +Xg axis and 88 deg 2 from 
the -Z B axis. The +X p2 axis is in the +Yg axis direction. 

The ^ F2 axis completes the righthand set. 
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(b) 


ACAD REFERENCE 
COORDINATES 



Figure A-4 . (a) FHST Coordinate Systems and (b) FHST 

Orientation Relative to Spacecraft Body 
Coordinates 
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Figure A- 6 . 


FSS Orientation Relative to Spacecraft 
Body Coordinates 




A - 10 HIGH-GAIN ant e nna REFERENCE SYSTEM (X a , Y a, Z a ) 

The high-gam antenna (HGA) reference system is defined in 
Figure A-7, where it is specified to be a 49.7423-deg rota- 
tion about the spacecraft body pitch axis (Y ). 

B 

A - 11 HIGH-GAIN ANTENNA LINK OF STGHT 

The HGA line of sight (LOS) is illustrated in Figure A-8, 
where the elevation angle (EL) and the azimuth angle (AZ) 
are defined. 
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APPENDIX B - GRO SURFACE AREA MODEL 


The surface area model for the GRO spacecraft is composed of 
flat plates and cylinders. The model is represented in Fig- 
ure B-l and described in Table B-l. 





Figure B-l. GRO Surface Area Model 
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Table B-l. Parameters for GRO Surface Area Model 
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APPENDIX C - UTILITY AND INITIALIZATION SUBROUTINES 


This appendix contains algorithm descriptions of standard 
subroutine packages that will be used in the dynamics simu- 
lator. Section C.l describes utilities CEULER, EULERC, 
DATE, DCROSS , DGMPRD, DGMTRA, DUNVEC, GAUSS, JD, INVERT, 
ORTHO, ROTMAT, ROTMT4 , TCON20, and TCON40. Section C.2 de- 
scribes the FASTOX orbit propagator and the Sun and Moon 
position routine, SMPOS . 

C. 1 UTILITY SUBROUTINE DESCRIPTIONS 

C.1.1 CEULER 


Subroutine CEULER converts a direction cosine matrix (or any 
orthogonal matrix) to a set of Euler symmetric parameters. 
The direction cosine matrix can be expressed in terms of the 


Euler 

symmetric parameters as 

follows 

(Reference 11) : 


’2 2 2 2 

q : - q 2 - q 3 + q 4 

2 ( q l q 2 + 

q 3 q 4> 

2 < q l q 3 - q 2 q 4 ) 


[C] = 

2 ^ q 1 q 2 " q 3 q 4 } 

2 2 
" q l + q 2 - 

2 2 
q 3 + q 4 

2(q 2 q 3 + q x q 4 ) 

(C-l) 



2(q 2 q 3 " 

q l q 4> 

2 2 2 2 



2 ( q l q 3 * q 2 q 4 ) 

- q l - q 2 + q 3 + q 4 



If the attitude matrix [C] is known, the Euler symmetric pa- 
rameters q , q 2 , q 3 , and q 4 can be solved for in terms of 
the components of [C] . 

Four distinct sets of equations can be derived from Equa- 
tion (C-l) . All are mathematically equivalent. However, 
numerical inaccuracy can be minimized by avoiding calcula- 
tions in which the Euler symmetric parameter appearing in 
the denominator is close to zero. This is the criterion 
used for choosing a representation. 
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Subroutine CEULER performs the following; 

If 1 + + C 22 + C 33 > e,* Equations (C-2 

(C-2d) are used: 


q 4 2 ( 1 + C H + C 22 + S 3 ) 1/2 
q l = 4q^ (C 23 “ C 32 J 


q 2 4q 4 (C 31 C 13 ) 


q 3 " 4^ <S 2 - Sl> 

If 1 + C lx - C 22 - C 33 > e. Equations (C-3a) 
through (C-3d) are used: 

"I - 2 f 1 + C 11 - =22 - = 33 ) ^ 
q 2 _ 4q 1 ^ C 12 + Si ^ 


q 3 4q 1 ^Sl + C 13 ^ 


q 4 4q x ^ C 23 S 2 ^ 


*e is the tolerance for choosing a representation. 


a) through 

(C-2a) 

( C-2b) 

(C-2c) 

(C-2d) 

(C-3a) 

(C-3b) 

(C-3c) 

(C-3d) 
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3. If 1 - C 11 + C 22 - > e. Equations (C-4 

through (C-4d) are used: 


q 2 2 C 11 + C 22 C 33^ 


q l 4q 2 (C 12 + C 21 ) 


q 3 " 4q 2 (C 23 + C 32 ) 


l 4 ~ 4q 2 (C 31 C 13 ) 


4. If tests 1 through 3 fail. Equations (C-5a 
(C-5d) are used: 


q 3 2 ( 1 C 11 C 22 + C 33^ 


q l " 4q 3 (C 31 + C 13 > 


q 2 4q 3 ^ C 23 + C 32^ 


q 4 " 4q 3 (C 12 C 21 ) 


C.1.2 EULERC 

Subroutine EULERC computes the direction cosine mat 
corresponds to a set of Euler symmetric parameters. 


a) 

( C-4 a ) 
(C-4b) 

( C-4c ) 

(C-4d) 
) through 

(C-5a) 

(C-5b) 

(C-5c) 

(C-5d) 

:ix that 

If v 
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q^/ / and q^ are the four Euler symmetric parameters, the 

direction cosine matrix is given by Reference 11: 


11 

C 12 

C 13 

21 

C 22 

C 23 

31 

C 32 

C 33 


2 2 2 2 
1 - ^2 - q 3 ‘ q 4 

2 ( q l q 2 + q 3 q 4 } 

2( q i q 3 - q 2 q 4 ) 

2 <^2 - q 3 q 4> 

-**1 + <*2 “ q 3 + q 4 

2(q 2 q 3 + q 3 q 4 ) 


2(q 2 q 3 - 4 1 < J 4 ) 

2 2 2 . 

2( q i q 3 + q 2 q 4 ) 

-qi - q 2 + q 3 + 


The matrix [C] may be normalized at the user’s discretion by 

[C] 


'NORMALIZED 


C. ./ E 
l] norm 


i . 

-Ii/l 


where i 

j 

E 

norm 

In theory. 


1-3 


1-3 

2 


q 2 + 


+ 


2 

q 4 


4 

E’h 1 

i = l 

However, q^ q 2 , q 3 , and q 4 are obtained by integrating the 
equations of motion. Errors caused by approximating the 
state equations or by roundoff may cause numerical inaccu- 
racies such that 


4 



i = l 
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C . 1 . 3 DATE 


Subroutine DATE converts* a given Julian day into the corre- 
sponding calendar date. 

C.1.4 DCROSS 

Subroutine DCROSS computes the cross-product of two vectors, 
A and B, as cT = A x B: 


A " ( a l' a 2' a 3) 

B = ^ b 1 , b 2 , b 3 j 



V 


a 2 b 3 - 

a 3 b 2 

c = 

C2 

C 3 


a 3 b l - 
_ a l b 2 - 

a l b 3 
a 2 b l _ 


C . 1 . 5 DGMPRD 

Subroutine DGMPRD computes the product of two input matrices 
[A] and [B] to form [C] = [A] [B] . DGMPRD uses the fact that 
matrices are stored in columns as a linear array when forming 
the product [C] . 

C . 1 . 6 DGMTRA 

Subroutine DGMTRA computes the transpose of an input 
matrix A: 


where i is 1, 


[A] = [a i;j ] 

[A] T = [ 9ji ] 
m and j is 1 , . . . , n . 
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C . 1 . 7 DUNVEC 


Subroutine DUNVEC takes an input vector, "v, and returns a 
unit vector coincident with the input vector and the magni 
tude of the input vector. 

C.1.8 GAUSS 


Subroutine GAUSS generates a normally distributed random 
number, V, with a given mean, p, and standard deviation, 


V is computed as follows. A random number, X, with a 
form distribution on (0, 1) is generated by subroutine 

RANDU. A table of values (Y^ Y 2 Y 2(J1 ) describi 

uniform distribution is available to subroutine GAUSS. 
Jth element is chosen from this table, where J = 200 • 


uni- 


ng a 
The 
X + 


(J is converted to an integer such that 1 < j < 201.) 


v =Yj*a+p if I* > o 

= -Y, a + p I * < 0 


where I* is an integer calculated by subroutine RANDU and 

Yj is the element chosen from the normal distribution 
table . 

C . 1 . 9 JD 

Subroutine JD converts a calendar day to the corresponding 
Julian day (Reference 11). 

C.1.10 INVERT 

Subroutine INVERT computes the inverse of a matrix and 
solves the set of simultaneous linear equations [A] [X] = 

[C] . INVERT computes [A] ^ and the solution [X] = [A] - '*' 
[C]. 
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c.1.11 ORTHO 

Subroutine ORTHO constructs a 3 by 3 orthogonal matrix that 
rotates vectors from coordinate system S' to coordinate sys- 
tem S. The user specifies two vectors u and v that define 
the S frame, where only u must be a unit vector. The user 
must also specify the order of the rotations. The S axes are 

defined by the unit vectors i, j, and k, where i is along u, 

/> '> 

j i s along ~v - (u • v)u, and k is orthogonal to i and j . 

The matrix [A] that transforms vectors from S' to S is con- 
structed as follows. The column vedtors of [A] are 


where j is 1-3 


1 , i 
L 2 , i 


= u 


where i is 1-3 


3 , i 


1, j 
'2, j 
'3, j 


= U X 


— a* /N 

V X u 

— ^ ZN I 

V X u 


1 , k 
^2 , k 


,-a. A. 

= +(v X u) 


3 , k 


where k is 1-3. 

(The + or - sign is chosen so that the resulting coordinate 
system is right handed.) It should be noted that i ^ j / k. 
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C.1.12 ROTMAT AND ROTMT4 * 


Subroutine ROTMAT constructs a coordinate transformation 
matrix, given an ordered set of rotation angles and the axis 
about which the rotations are to be performed. A simple ro- 
tation about the Z-axis by an angle 4> is illustrated in 

Figure C-l. The direction cosine matrix for this rotation 
is given by A 3 (<J>) . 


V*) 


cos <t> sin <j> 0 

-sin <J> cos <J> o 

0 0 1 


The direction cosine matrix for a rotation of an angle 4> 
about the X-axis is given by A-j^ ( 4>) : 


A X (<1>) 


1 0 0 

0 cos <f> Sin 4> 

0 -sin 4> cos <j> 


The direction cosine matrix for a rotation of angle <f> 
about the Y-axis is given by : 


a 2 (4>) 


cos <$> 0 -sin <J> 

0 1 o 

sin <j> 0 cos <J> 


*ROTMAT is used for double-precision computations, 
ROTMT4 is used for single-precision computations. 


whereas 
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If the X-, Y-, and Z-axes are denoted as the 1, 2, and 3 axes 
of rotation, the coordinate transformation matrix [T] can be 
computed, given the ordered set of rotation angles: 

[T] = A.(<j>) A. (4>) A k (<|>) 

where i, j, k is any permutation of the axis of rotation (1, 
2, 3) as determined by the order in which the rotations are 
to be performed. 

C.1.13 TCON20 

Subroutine TCON20 converts time in seconds since 0 hours 
universal time (UT) September 1, 1957, to a calendar format 
( YYMMDD . HHMMSSMMM) . 1 

C.1.14 TCON40 

Subroutine TCON40 converts a given date in a calendar for- 
mat to seconds since 0 hours UT September 1, 1957. 

C. 2 EPHEMERIS tJTTT.TTTFS 

C . 2 . 1 FASTOX 

Routine FASTOX is a two-body orbit generator that computes 
the position and velocity of a spacecraft given the 
Keplerian elements, the time from epoch, and the gravita- 
tional constant of the central body. The Keplerian elements 
include the semimajor axis, a; the eccentricity, e; the in- 
clination, i; the right ascension of the ascending node, 

0; the argument of perigee, co; and the mean anomaly at 
epoch, M o . A user option indicates if Earth perturbations 
are to be included in the calculations and if the velocity 
is to be computed. 


Calendar format: Year-month-day-hour-minutes-second- 

milliseconds . 
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Using Kepler's equation to determine the position and veloc- 
ity, the mean anomaly, M, at some time, t, is related to the 
eccentric anomaly, E, at the same time by 

M = E - e sin E (C-6) 

If t is the epoch time of the elements, the mean anomaly 
o 

at time t is found from the mean anomaly at epoch by 

M = M q + n(t - t Q ) (C-7) 


where n = 2ir/period is the mean motion. FASTOX solves 
Kepler's equation numerically to find E at any time before 
or after the epoch using an iterative solution to Equa- 
tion (C-6), obtained using Newton's method. Successive 
estimates of E are given by 


M + e sin (E i _ 1 > - E i_i 
E i = E i-1 + 1 - e cos (E i _ 1 ) 


( C-8 ) 


where the starting value E q = M. If M = 0, the solution 
is trivial and therefore implies that E = 0. The iteration 

-7 

continues until either the correction term is < 1 x 10 
or until 75 iterations have occurred. Once the eccentric 
anomaly is found, the true anomaly, v, and the distance, 
r, may be found from 


sin v 


1/2 


1 - e 


sin E 


1 - e cos E 


(C-9) 


cos V 


cos ( E ) - e 
1 - e cos E 


(C-10) 


r = a(l - e cos E) 


(C-ll) 
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Equations (C-9) through (C-ll) thus give the position of the 
spacecraft in the orbit plane. The orientation of the orbit 
in space must be considered to find the position relative to 
an inertial system. Using spherical triangles, 

x - r [cos (co + v) cos A - sin (co + v) sin A cos i] (C-12) 

y = r [cos (co + v) sin A + sin (co + v) cos A sin i] (C-13) 

z = r[sin (co + v) sin i] (C-14) 

where x, y, and z are resolved in the coordinate system in 
which the elements are defined. It is possible to use Equa- 
tions (C-9) and (C-10 ) to remove the explicit true anomaly 
dependence in Equations (C-12) through (C-14) and therefore 
to compute the position directly. 

The velocity at time t is found by applying the extended 
chain rule to Equations (C-12) through (C-14). Thus, for 
example , 

dx = 9x8r9E 9 x9v3e 

dt 3r 3E 3t + 3v 3E 3t (C-15) 

assuming co. A, and i are constant. The quantity dE/dt may 
be found by differentiating Kepler*s equation to obtain 

dM _ dE „ dE 

dt " dt " e cos E dt (C-16) 

so that 

dE 1 dM 

dt 1 - e cos E dt (C-17) 
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The equations for the velocity are as follows: 

(C-18 ) 
(C-19 ) 
(C-20 ) 

where = -cos ft sin w - sin ft cos co cos i 
k 2 = cos n cos co - sin ft sin co cos i 
a = -sin ft sin co + cos ft cos co cos i 
0, 2 = sin ft cos co + cos ft sin oj cos i 
= cos co sin i 
= sin 03 sin i 

The above procedure is not coordinate-system dependent, 
i.e., the position and velocity will be in whatever coordi- 
nate system the elements of the orbit are defined. 

C . 2 . 2 SMPOS 

Subroutine SMPOS computes the positions and distances of the 
Sun and Moon relative to the Earth. This method requires no 
input other than the time for which these quantities are de- 
sired and gives solar position errors up to about 0.01 deg 
and lunar position errors up to about 0.25 deg. 

C.2.2.1 Solar Ephemeris 

C. 2. 2. 1.1 Mean Motion of the Sun 

The mean motion of the Sun is given by Reference 18 as 

L = 279 .°696678 + 0.9856473354(d) + 2.267 x 10 13 (d 2 ) 


dx 

dt 


na 

r 


a 1 - e' 


1/2 


cos E - ak 2 sin E 


dy 

dt 


na 


9 \ 1/2 

a |l _ e Q., cos E - a2. sin E 


dz 

dt 


r , 1/2 

n a a |i _ e z J cos E - am 2 sin E 
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g = 358 . °475845 + 0.985600267(d) - 1.12 x 10 _13 (d 2 ) 
- 7 x 10 -20 (d 3 ) 


e = 0.016751 


where L 


g 

e 

d 


mean longitude of the Sun, referred to the mean 
equinox of date 

mean anomaly of the Sun 

eccentricity of the terrestrial orbit 

number of ephemeris days since 1900 January 0 d 12 h 
ephemeris time, which is Julian day 2 415 020 


For the purpose of this ephemeris, the number of ephemeris 
days is taken to be equal to the number of Julian days, and 
the reduction of universal time to ephemeris time is not 
performed . 


The motion of the Earth about the Sun is, to a good approxi- 
mation, a two-body problem. The eccentricity of the orbit 
is significant and is considered in the next subsection. 

The apparent motion of the Sun is considered to lie entirely 
in the ecliptic plane. 


C. 2. 2. 1.2 Corrections to the Mean Motion 

Reference 19 gives a sine series to correct the mean motion 
of the Sun for the eccentricity. The two largest terms have 
amplitudes exceeding 1‘ of arc and are (converted to degrees 
and for an epoch at the year 2000) 


SL = 1.918° sin (g) + 0.0201° sin (2g) 

The celestial longitude of the Sun is thus computed as 


X — L + 6 L 
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The celestial latitude of the Sun is 0 by the assumption 
that the apparent motion lies in the ecliptic plane, i.e., 

B = 0 

C. 2. 2. 1.3 Calculation of the Earth-Sun Distance 

The distance from the center of the Earth to the center of 
the Sun, R„, is computed from the expression for the dis- 
tance in an elliptic orbit: 


R = — a(l - e 2 ) , _ 

S 1 + e cos (f) 

g 

where a = semimajor axis = 1 Au = 1.495 x 10 km 
f = true anomaly = g + 6L 

C.2.2.2 Lunar Ephemeris 

C. 2. 2. 2.1 Mean Motion of the Moon 

The mean motion of the Moon, as described in Reference 18, 
is (Figure C-2) 

— X 3 2 

(£ = 270 . °434164 + 13.1763965268(d) - 8.5 x 10 (d ) 

+ 3.9 x 10 -20 (d 3 ) 

— 1 2 2 

r ' = 334 . °329356 + 0.1114040803(d) - 7.739 x 10 (d ) 

_ i q t 

-2.6x10 (d ) 

Q. = 259 .°183275 - 0.529539222(d) + 1.557 x 10 _12 (d 2 ) 

r . ,,-20 , . 3 > 

+ 5 x 10 (d ) 
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D = 350 . °737486 + 12.1907491914(d) - 1.076 x 10 (d ) 
+ 3.9 x 10 -20 (d 3 ) 

i = 5.145396374 


where 


C 


r* 


n 

D 

i 


mean longitude of the Moon, measured in the 
ecliptic from the mean equinox of date to the mean 
ascending node, and then along the orbit 

mean longitude of the Moon’s perigee, measured as 
above 

longitude of the mean ascending node of the 
lunar orbit, measured in the ecliptic from the 
mean equinox of date 

(^ - L = mean elongation of the Moon from the Sun 
inclination of the lunar orbit to the ecliptic 


The motion of the Moon about the Earth cannot be reasonably- 
approximated as a two-body problem, even for coarse attitude 
systems. Corrections to the mean motion are discussed in 
the next section. 


C.2.2.2.2 Corrections to the Mean Motion 

Brown (Reference 20) gives corrections, 6(J, to the Moon's 
mean longitude in the form 


6 (£- A sin [&((£- r ' ) + &’(g) + F((Q- Q) + d(D) ] 


Only the 10 largest solar perturbations to the motion of the 
Moon and the 2 largest eccentric terms have been considered 
here. These are given in Table C-l. 

Note that, while Brown identified approximately 1600 periodic 
terms in the motion of the Moon, only about 10 percent of 
these have amplitudes in excess of 1 minute of arc. 
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Table C-l. 

Periodic Terms 

in the 

Longitude 

of 

the Mo 

Term 

A 





Number 

(degrees) 

a 

a 1 

F 


1 

+6.289 

1 

0 

0 

0 

2 

-1.274 

1 

0 

0 

-2 

3 

+0.658 

0 

0 

0 

2 

4 

+0.213 

2 

0 

0 

0 

5 

-0.185 

0 

1 

0 

0 

6 

-0.114 

0 

0 

2 

0 

7 

-0.059 

2 

0 

0 

-2 

8 

-0.057 

1 

1 

0 

-2 

9 

+0.053 

1 

0 

0 

+2 

10 

-0.046 

0 

1 

0 

-2 

11 

+0.041 

1 

-1 

0 

0 

12 

-0.035 

0 

0 

0 

1 


Once the corrected longitude <£■ = (Tt 6 ({is obtained, 

the celestial latitude, 15, and longitude, X, are obtained 
from (Figure C-2) 


j tan (X - fl) * tan ((£ - Cl) C os (i) 

| tan (|3) = sin (X - Cl) tan (i) 

C.2.2.2.3 Calculation of the Earth-Moon Distance 

Brown gives a cosine series for the lunar parallax with the 
same arguments as given for 6{[. The nine largest terms in 
this series (those with amplitudes exceeding l second of 
arc) were used (Table C-2). 

The distance, R m , from the center of the Earth to the 
center of the Moon may be found from the parallax, p, as 


R 


_ £378.388 
m sin (p) 


(km) 
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Table C-2 


Periodic Terms in the Lunar Parallax 


Term 

Number 

1 

2 

3 

4 

5 

6 

7 

8 
9 


A 

arc seconds i 

3422.7 0 

186.5398 1 

34.3117 1 

28.2373 0 

10.1657 2 

3.0861 1 

1.9178 0 

1.4437 1 

1.1528 1 


ft ' F d 

0 0 0 

0 0 0 

0 0-2 

0 0 2 

0 0 0 

0 0 2 

10-2 
10-2 
-10 0 
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SHRTPUL ACTPULSE R*4 0«256 sec ACT short pulse time 

STAND ACADMD 1*4 1 - Use standby ACAD mode 

SUNREF ACADMD 1*4 4 - Use Sun-referenced pointing ACAD 
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GLOSSARY 


ACAD 

ACADS 

ACE 

ACS 

ACT 

AIDR 

AMB 

BASD 

BATSE 

BCS 

BOL 

CADHS 

CM 

COMM 

COMPTEL 

CPE 

CSS 

DBC 

DEA 

ECI 

EGRET 

EOL 

EPDS 

FHST 

FOV 

FSS 

GCI 

GGS 

GRO 

HGA 

HGAD 

IDT 


attitude control and determination 

Attitude Control and Determination Subsystem 

attitude control electronics 

antenna coordinate system 

attitude control thruster 

acceleration-insensitive drift rate 

Adams-Moulton-Bashf orth 

Ball Aerospace Systems Division 

Burst and Transient Source Experiment 

body coordinate system 

beginning of life 

Communications and Data Handling Subsystem 
center of mass 

contingency orbit maintenance mode 
Imaging Compton Telescope 
control processing electronics 
coarse Sun sensor 
data base constant 
drive electronics assembly 
Earth-centered inertial 

Energetic Gamma Ray Experiment Telescope 
end of life 

Electrical Power Distribution Subsystem 

fixed-head star tracker 

field of view 

fine Sun sensor 

geocentric inertial 

Goddard GRO Simulator 

Gamma Ray Observatory 

high-gain antenna 

high-gain antenna drive 

image dissector tube 
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IGRF 

IRU 

LGA 

LOS 

MDE 

MMS 

MO I 

MPS 

MSFC 

MTA 

NMM 

NPM 

NSSC-1 

OAT 

OBC 

OBCS 

OSSE 

PE 

PROM 

PS 

RFOV 

RSM 

RW 

RWA 

RWAHM 

RWEA 

SCIO 

SHM 

SM 

SRPM 

STS 

TAHM 


International Geomagnetic Reference Field 

inertial reference unit 

low-gain antenna 

line of sight 

motor drive electronics 

Multimission Modular Spacecraft 

moment of inertia 

Modular Power Subsystem 

Marshall Space Flight Center 

magnetic torquer assembly 

normal maneuver mode 

normal pointing mode 

NASA Standard Spacecraft Computer, Model 1 
orbit adjust thruster 
onboard computer 
origin of the BCS frame 

Oriented Scintillation Spectrometer Experiment 

propulsion electronics 

programmable read-only memory 

Propulsion Subsystem 

reduced field of view 

roll scan mode 

reaction wheel 

reaction wheel assembly 

reaction wheel attitude hold mode 

reaction wheel electronics assembly 

simulation control and input/output 

safe-hold mode 

standby mode 

Sun reference pointing mode 
Space Transportation System 
thruster attitude hold mode 
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TAM 

TBD 

TCM 

TCS 

TDE 

TDRS 

TFOV 

TM 

TMM 

TTU 

UTC 

VCM 


three-axis (triaxial) magnetometer 
to be determined 
thruster command mode 
Thermal Control Subsystem 
torquer drive electronics 
Tracking and Data Relay Satellite 
total field of view 
Truth Model 

thruster maneuver mode 
time transfer unit 
universal time coordinated 
velocity control mode 
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